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Part I 


BASIC MECHANICS 





CHAPTER ONE 


Particle Kinematics 





INEMATICS is a branch of dynamics that studies aspects of motion apart 

from considerations of masses and forces. Essentially, Kinematics is a col- 
lection of vector/matrix methods to describe positions, velocities and accelera- 
tions of particles and rigid bodies, as viewed from various reference frames. The 
sub-field of Particle Kinematics considers only the motion of particles. This 
in itself can be quite challenging at times. As an example, consider a person 
driving a car on the highway. The road itself is fixed to a constantly rotating 
Earth which in turn is orbiting the sun. What is your velocity and acceleration 
relative to a Sun-fixed coordinate system? This chapter will help answer these 
and many related questions. 


1.1. Particle Position Description 


1.1.1 Basic Geometry 


When studying the kinematics of particle motion, one is not concerned about 
the physical dimensions or mass of a particle. Let P be a point in a three- 
dimensional space as illustrated in Figure 1.1. To define the position of the 
point P, a coordinate system along with its origin must be chosen. Without 
this coordinate system, it is difficult to describe the position of point P. To 
visualize this problem, imagine one person A telling another person B that 
their location is “10 miles.” Without knowing from what reference point person 
A measured 10 miles and in what direction it was measured, it is impossible for 
person B to know the meaning of “10 miles.” 

A coordinate system is defined by two things. First, a coordinate system 
origin O must be established to specify its position in space. Second, the orien- 
tation of the coordinate system must be chosen. By choosing the orientation of 
the coordinate system a person will know what is considered “up” or “east” as 
measured within this coordinate system. Three perpendicular (or orthogonal) 
right-handed unit vectors are traditionally used to denote unit displacement 
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directions along the orthogonal axes. In Figure 1.1 a standard cartesian coor- 
dinate system labeled as € is shown. The three unit vectors €;, €2 and é3 are 
used to define the orientation of € and the coordinate system origin is denoted 
by Og. We will label all unit vectors with a (*) symbol. When assigning the unit 
vectors to the coordinate system, the first two unit vectors typically span the 
local “horizontal plane,” while the third unit vector points in the “upwards” di- 
rection normal to the plane of the first two unit vectors. However, this sequence 
and interpretation is not required. 





Figure 1.1: The Cartesian Coordinate System 


A coordinate system, defined through the origin and the three unit direction 
vectors, is often referred to as a reference frame. Vectors with components 
taken in different coordinate systems are said to be written in different reference 
frames. More generally, think of a reference frame as a rigid body. While the 
Earth is a rigid body, there is an infinite set of coordinate systems that could be 
embedded in the Earth-fixed reference frame. For the present, we will usually 
associate only one coordinate system with a reference frame (rigid body). 

Let r = OgP be the vector pointing from the coordinate origin O¢ to the 
point P. Note that there are an infinite number of ways to parameterize that 
vector in terms of orthogonal coordinate axis components. To write the posi- 
tion vector r in the cartesian coordinate system € shown in Figure 1.1, it is 
broken down (i.e. projected orthogonally) into the three components along the 
coordinate system unit axes. Let the €; component of r be called x, the é2 
component be called y and the €3 component be called z. Then the vector r is 
written in the € cartesian coordinate system components as 


r= pr = xe, + yen + 263 (1.1) 
The short hand notation “r is used when we wish to specify that the vector 
components of r are taken along the unit directions vectors of the € coordinate 
system. The superscript coordinate system label is often omitted when it is 
clear in which system the components are taken or, more likely, one wishes to 
preserve the freedom to choose a particular coordinate system at a later point. 


SECTION 1.1 PARTICLE POSITION DESCRIPTION 5 


When it is clear in context, we can also use “r to denote the € frame base vector 
components of r as the 3x1 column vector (matrix) 


E 
x 


ep y (1.2) 
z 


For cartesian coordinate systems, the +th entry of the column vector is the 
component of the r vector along the +th unit vector é;. 

Care must be taken when performing vector operations if multiple coordinate 
systems are used. Writing a vector addition as 


q=r+p 


is correct since no coordinate systems have been assigned yet; this equation 
has an infinity of possible component descriptions. We mention that one of 
the subtle and powerful facts of vector algebra is the ability to derive vector 
equations that hold for all possible component parameterizations of the vectors. 
However, if the vectors have specific coordinate systems components as shown 
in Eq. (1.2), then the following matrix vector addition would not be correct. 


E E B 
q1 ry Pi 
q2)} = [re] t+ | Po 
93 T3 D3 


The vector p is here written in 6 frame components while all other vectors are 
expressed in the € frame. To add the 6 frame components of the p vector to € 
frame vectors, these components would first have to be transformed (projected) 
from the 6 frame to the € frame. Later on in Chapter 3 it will be shown how 
the direction cosine matrix can be used to perform this transformation. 





Figure 1.2: The Cylindrical Coordinate System 
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1.1.2 Cylindrical and Spherical Coordinate Systems 


While the cartesian coordinate system is the most common and the easiest one 
to visualize, many times it is not the easiest to use. This is particularly true 
if the motion of Point P is of a rotational type or if the dominant forces are 
radial. In these cases it is usually easier to use either a cylindrical or spherical 
coordinate system. When we address dynamics in Chapter 2, we will provide 
some insight on coordinate system selection in the context of solving example 
problems. 

A cylindrical coordinate system C is illustrated in Figure 1.2. Its orientation 
is defined through the triad of unit vectors {Gq, G9, é3}. This system is partic- 
ularly useful in describing particles rotating about an axis €3 which are free to 
move parallel to the axis é3. For a large number of problems having rotational 
symmetry of force fields or constraint surfaces, cylindrical coordinates would be 
an attractive choice. For example, consider a particle constrained to move on 
the surface of a cylinder. Contrary to the inertially fixed cartesian coordinate 
system A, two unit orientation vectors of the cylindrical coordinate system are 
varying with @ as seen from NV. These are the unit vector ég and ég. They 
rotate in the horizontal plane perpendicular to the é3 unit vector. The vector 
€a tracks the heading of the projection of the r position vector in this horizontal 
plane. The position vector r of point P is expressed in cylindrical coordinates 
as 


“Yd 
r= =dég+ 263 = | 0 (1.3) 
z 


where the scalar d is the radial distance of point P from the é3 axis. The 
second entry of the cylindrical coordinate system column vector in Eq. (1.3) 
will always be zero. Any particle position vector expressed in a cylindrical 
coordinate system will never have a component along the ég direction. Note 
that in Eq. (1.3) the unit vector ég has a variable direction as observed from 
N. The angle 6 describes how far ég has rotated from the é; axis. Therefore, 
instead of using (x, y, z) cartesian coordinates to describe a position, cylindrical 
coordinates use d and z, and the angle 6 provides the azimuth angle of the unit 
vector Gq relative to €;. Assuming éz3 is aligned with é3, the unit vectors Gg and 
Gg can be related to é; and é2 through 


Ca = cos 0€, + sin 0é€2 (1.4a) 
69 = — sin 0é, + cos 0é2 (1.4b) 


A spherical coordinate system S is illustrated in Figure 1.3 with its orienta- 
tion defined through the triad of unit vectors {8,, 89,4}. Note that all three 
unit orientation vectors are time varying for the spherical coordinate system as 
seen from NV. The unit vector 8, now points from O, towards point P. Let 
the scalar r be the radial distance from the coordinate system center Og to 
the point P. Then the position vector r is expressed as components along the 


SECTION 1.1 PARTICLE POSITION DESCRIPTION 7 





Figure 1.3: The Spherical Coordinate System 


spherical coordinate triad {8,, 89, 8g} as 


r= =rTs,= |0 (1.5) 


A particle position vector written as a column vector with components taken 
in the S frame will have a non-zero entry only in the first position. As shown 
in Figure 1.3, the two angles 6 and ¢ completely describe the orientation of the 
unit vectors 8,, 89 and 84 relative to the three é; (i = 1,2,3). Therefore, the 
{8,, 89, 8¢} projection onto {é1, é2,é3} with components a function of (r, 0, ) 
are 


8, = cos dcos O€; + cos dsin Jég + sin Gé3 (1.6a) 
So = —sin 0€, + cos 0é (1.6b) 
84 = —sin dcos 0€; — sin dsin 0é2 + cos dé3 (1.6c) 


Spherical coordinates and the associated triad of unit vectors {8,, 89, 84} are 
very useful when describing a particle motion on the surface of a sphere or a 
particle orbiting a body. 


Example 1.1: Given a vector r written in the cartesian coordinate system 
Eas 
E 7s ‘ ie 
r= "rT = 2€; — 3€2 + 5é3 


Express r in terms of the cylindrical coordinate system C where ¢3 = é€3. 
From Eqs. (1.4), we can express €; and &2 in terms of Gg and é as 
é, = cos 0€q — sin 09 


é2 = sin 0éq + cos 0é9 
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Using this relationship the vector r is expressed in the C frame as 
r = “r = (2cos0 — 3sin 9) ég — (2sin@ + 3cos 6) é9 + 5é3 


The angle @ is resolved noting that in the C frame the Gg component must 
be zero. Therefore 6 must be 


6 =-—tan? (3) = —56.31° 


which brings “r to the desired result 


r =r = 3.61éq + 5é3 


1.2 Vector Differentiation 


1.2.1 Angular Velocity Vector 


In planar motion it is easy to define and visualize the concept of angular velocity 
as is shown in Figure 1.4(i). For this single axis €3 rotation case, the rotation 
angles and rotation rates (angular velocities) are only scalar quantities. The 
instantaneous angular rate w of a particle is given by 


w= 6 (1.7) 


where a positive rotation or rotation rate is defined to be in the increasing 6 
(counterclockwise) direction shown. Angular velocity of a particle in a plane 
simply describes at what rate the radius vector locating the particle is orbiting 
the origin. 





i) Planar Case ii Three- 
(i) 
Dimensional Case 


Figure 1.4: The Angular Velocity Vector 


For the general three dimensional case, we will prove in Chapter 3 that a 
general large angular displacement is not a vector quantity; however, paradox- 
ically, angular velocity is a vector quantity. For the present, we limit ourselves 
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to an argument based upon small angular displacements to introduce the an- 
gular velocity vector. As the rigid body shown in Figure 1.4(ii) rotates about 
the body- and space-fixed é axis by the small angle A@, the body-fixed point 
at position P’ rotates to position P”. This rotation is described through the 
rotation vector A@ defined as 


A@ = Abe (1.8) 


The angular velocity vector is the instantaneous angular rate at which this 
rotation occurs. Let the angular velocity vector magnitude be w, then the 
vector w can be written as 


w= we (1.9) 


The unit direction vector é defines an axis about which the rigid body or 
coordinate system is instantaneously rotating. For the case of planar rotations 
in Figure 1.4(i) the rotation axis is simply é3. Note that any orientation of 
a rigid body can be defined by the orientation of any body-fixed coordinate 
system. Therefore position descriptions for rotating rigid bodies and rotating 
coordinate systems are actually the same problem geometrically and there is no 
need to formally distinguish between the two. For the case of constant é it is 
natural to define 


w= lim — (1.10) 


The angular velocity vector w of a rigid body or coordinate system B relative 
to another coordinate system NV is typically expressed in B frame components. 


By = wb, + tio be + w3b3 (1.11) 
Each component w; expresses the instantaneous angular rate of the body B 
about the 7-th coordinate axis b; as shown in Figure 1.5. The w; components 
are obviously the orthogonal components of w. As will be evident in Chapter 
3, it is often convenient to describe w with non-orthogonal components as well. 





Figure 1.5: Illustration of Angular Velocity Body Frame Components 
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1.2.2 Rotation about a Fixed Axis 


It is instructive to study in detail the rotation of a rigid body about a fixed 
axis. In particular, the velocity vector r of a body-fixed point P is examined. 
Let a body 6 have a rod attached to it which is fixed in space at points A and 
B as shown in Figure 1.6 so the rod is the axis of rotation. The rigid body 
B is rotating about this rod with an angular velocity w. The origin O of the 
coordinate system for B is located on the axis of rotation. Let P be a body- 
fixed point located relative to O by the vector r. The angle between the angular 
velocity vector w and the position vector r is 0. 





Figure 1.6: Rigid Body Rotation about a Fixed Axis 


Studying Figure 1.6 it is quite clear that the body-fixed point P will have 
no velocity component parallel to the angular velocity vector w; i.e., P moves 
in a plane perpendicular to the w axis. If one would look down the angular 
velocity vector one would see P moving on a circle with radius rsin@ while 
being “transported” with the rotating rigid body. Thus the speed of P is given 
by 

|r] = (rsin 6) w (1.12) 
Studying Figure 1.6 further it is apparent that the inertial velocity vector of P 


will always be normal to the plane of r and w. This provides the direction of r 
which can then be written as 


* = (rsiné)w (-*) (1.13) 


lw x rr} 
However, note that jw x r| = wrsin 6, so the transport velocity is 


r=wxr (1.14) 
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The only restriction for Eq. (1.14) is that r must be a body-fixed vector within B. 
As was mentioned earlier, the concepts of rigid bodies and reference frames can 
be used interchangeably. The above result would also hold if we are finding the 
velocity vector fixed to any reference frame which is rotating relative to another; 
as is evident below, this easily generalizes for three-dimensional motion. 


1.2.3. Transport Theorem 


As was mentioned earlier, it is simpler to define a particle position in terms 
of cylindrical or spherical coordinate systems. However, when computing the 
velocity of the particle and taking the time derivative of the position vector, one 
must take into account that the base vector directions of the chosen coordinate 
system may be time varying also. The following transport theorem allows one 
to take the derivative of a vector in one coordinate system, even though the 
vector itself has its components taken in another, possibly rotating, coordinate 
system. 

Let N be an inertially fixed reference frame with a corresponding triad of 
N-fixed orthogonal base vectors {f1, Az, 23}. Let B be another reference frame 
with the B-fixed base vectors {b1, bo, bs}. For simplicity, let the origin of the 
two associated reference frames be coincident. Let ®r be a vector written in the 
B coordinate system. 


r= Bp = rib, + roby + r3b3 (1.15) 


We introduce the following notation: the angular velocity vector wx, defines 
the angular velocity of the B frame relative to the NV frame. An angular velocity 
vector is typically written in the B frame. Therefore we write wg/y as 


“win = wib, + webs + w3bs (1.16) 


At this point we introduce the notion of taking the vector time derivative 
while accounting for the reference frame from which the vector’s time variations 
are being observed. Imagine this: you are standing still on Earth’s surface. Let 
B be an Earth fixed coordinate system with the origin in the center of the Earth. 
Your position vector would point from the Earth’s center to your feet on the 
surface. By calculating the derivative of your position vector within B, you are 
determining how quickly this vector changes direction and/or magnitude as seen 
from the B system. You would find the time variation of your position to be zero 
when viewed from the Earth-fixed frame. This should be no big surprise; after 
all, you are standing still and not walking around on Earth. Now, let’s introduce 
another coordinate system V with the same origin, but this one is non-rotating 
and therefore fixed in space. Calculating the derivative of your position vector 
in the N frame, you wish to know how fast this vector is changing with respect 
to the fixed coordinate system N. Since Earth itself is rotating, in this case your 
position derivative would be non-zero. This is because relative to NV’, you are 
moving at constant speed along a circle about the Earth’s spin axis. 
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To indicate that a derivative is taken of a generic vector x as seen in the B 
frame, we write 
| 
— (x 
a () 
The derivative of 8r given in Eq. (1.15) with components taken in the B coor- 
dinate system is denoted by 


Bq Pe ie A A * 

—(r)=— = 7b) + fob2 +736 1.17 

a ( at 701 + P2b2 + 17303 (1.17) 
since the unit vectors 6; are fixed (i.e. time invariant) within the B frame and 
therefore the terms ®d/dt (6:) are zero. When taking the inertial derivative of 
5p however, these unit vectors must now be considered time varying as seen in 


NV. Therefore, using the chain rule of differentiation, we get! 


N, N, 


- (®r) = iby + robo + i'3b3 + ae (é:) + no (62) +130 (és) (1.18) 


However, since 6; are body-fixed vectors within B, Eq. (1.14) can be used to 
find their derivative in NV. 


NG 
dt 
Using Eqs. (1.17) and (1.19), Eq. (1.18) is rewritten as 


(6:) = way x 6; (1.19) 


Nq Ny B By B B 


However, note that it is not necessary for the vector r to be written in the B 
coordinate frame for Eq. (1.20) to hold, because ¥r is simply one of the infinity 
of possible components of the unique vector r. Rather, components can be 
written in any arbitrary coordinate frame. This result leads to the general form 


of the transport theorem. 


Theorem 1.1 (Transport Theorem) Let N and B be two frames with a rel- 
ative angular velocity vector of wgiy, and let r be a generic vector, then the 
derivative of r in the N frame can be related to the derivative of r in the B 
frame as 


Nd Bq 


a P) = ay) + ee XP (1.21) 


This formula allows one to relate a vector derivative taken relative to frame B 
to the corresponding vector derivative taken in frame NV’, where B and N are 
arbitrarily moving reference frames. This permits one to relate the derivative of 
r as it would be seen from the V frame to the analogous rate of change of r as 
seen in the B frame. It is a very fundamental and important result that is used 
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almost every time kinematic equations are derived. In particular, we will find 
that vectors are typically differentiated with respect to an inertial frame called 
N. However, the notation “d/dt (a) becomes cumbersome at times. When we 
want to compact the equation, we will use the following shorthand notation: 
MG 
—(%)=2 1.22 
= (2) (1.22) 


Example 1.2: The inertial velocity and acceleration vectors are sought 
for a general planar motion described in terms of polar coordinates with 
components taken along {é,,é9,é3}. The origin and base vectors of the 
polar coordinate system € are denoted 


E = {O, ér, €, €3} 


as shown in Figure 1.7. The inertial coordinate system having the same origin 
O is denoted 
N = {O, 71, Nz, rs} 


where 713 = €3. The position vector “r written in the € coordinate system is 


Let we, be the angular velocity vector of € with respect to NV. As is evident 
in Figure 1.7 this is simply 


We/N = 663 = Ons 





Arbitrary Path of P 
P 






ow 
Figure 1.7: Polar Coordinates Illustration 


Using the transport theorem in Eq. (1.21), the inertial velocity vector of r is 


found to be 
a 
r= — (‘r) + Wes X Ep 
dt 


Using the definition of p= ré, it is clear that 
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After carrying out the cross product term, the inertial velocity vector 7 is 
reduced to 


r= f=7é,+rbéo (1.23) 
where #* and ré are is the radial and the transverse velocity components, 


respectively. 


The inertial acceleration 7 is found by taking the inertial derivative of 7 using 
the transport theorem. 


a 


VO ae 


(7) + Wes xr 


Using the result for * that was just found, we obtain 


&| of bes 
< (#) = Fey + (i6 a 6) ds 


Again after carrying out the cross product and collecting terms, the inertial 
acceleration vector 7 is found to be 


pane= (i = 6”) é% (rd i 26) és (1.24) 


where # is the radial component, 76? is the centrifugal component, r6 is the 
tangential component and 270 is the coriolis acceleration component. 


It is instructive to obtain Eq. (1.24) by “brute force.” Notice we can write 
the NV frame rectangular components of position, velocity and acceleration 
as 

r=2ni + yNne 


r= rny Tr yne 





r= En} oe yne 


Since fi; are fixed in A’, the transport theorem is not required. Upon substi- 
tuting the polar coordinate transformations 


x=rcosé 


y=rsind 


and taking two time derivatives, you can obtain the lengthy trigonometric 
functions az(r,@) and ay(r,@) in 


PF = az(r, 0) + ay(r, 0) 
Finally, substituting 


ni = cos dé, — sin 0ég 


nz = sin 0é, + cos 09 


and performing considerable algebra, you will find all trigonometric functions 
of 6 cancel, leaving you with the same result as in Eq. (1.24). 
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1.2.4 Particle Kinematics with Moving Frames 


So far all coordinate systems or reference frames discussed were considered non- 
translating. Their origins were fixed inertially in space. Now a more general 
problem will be discussed where the coordinate frame origins are free to trans- 
late, while the frame orientations (defined through the three respective unit 
direction vectors) might be rotating. 






Reference Frame B 


Reference Frame A 


Figure 1.8: Two Coordinate Frames with Moving Origins 


Let P be a generic particle in a three-dimensional space. Assume two dif- 
ferent frames A = {O, 4 ,@2,@3} and B = {O', b1, bz, bs} exist as shown in 
Figure 1.8. The position of O’ relative to O is given by the vector R. Note that 
these two coordinate frames could be actually attached to some rigid bodies 
and define their position and orientation in space, or they could simply be some 
artificial coordinate sets placed there without any other physical significance. 
In this discussion, however, it is frequently useful to think of reference frames 
A and B as rigid bodies. 

Let the vectors r and p be the position vectors of particle P in the A and B 
frames respectively. The angular velocity vector of 6 relative to A is given by 
wp/4- Observe that the position vector r of P in the A frame can be related 
to R and p through the vector addition 


r=R+p (1.25) 
The shorthand notation (vo? Vig is used in this section to express the velocity 
vector of particle P with the derivative taken relative to the B frame. 
P *d 
(vo ),= +(e) (1.26) 
The velocity vector (v”’) , of P relative to the A frame is given by 


A A A A 
(0) 4= 4) =F (Rte) = 2 (Rt Fo) (1.27) 
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The velocity vector of the origin O’ in the A frame is defined to be 


(v) , = 7 (R) (1.28) 


Using the transport theorem and the definition in Eq. (1.28), the velocity vector 
oy. of Eq. (1.27) can be written as 


ae (vo) + (0?) +waya xp (1.29) 


To find the acceleration (aP ) a of particle P in the A frame, the derivative 
of Eq. (1.29) is taking in the A frame. 


(a?) , = = ((v”) 4) = = ((v) , els (v?) 4 + wea X p) (1.30) 


Allowing the differentiation operator to apply term-by-term in the last term, 
and using the transport theorem, (a? ) “A becomes 


Ad // of Bq 
(a?) =F ((e%) ) +z ((@?)p) + w/a x (0?) + 
Ad Bq 
on (wpa) X p+ wpa x (= (p) + wpa X p) (1.31) 


Looking at the first term, the acceleration of the origin O’ in the A frame is 


defined to be 
(0) =F ((»”),) (132) 


While looking at the second term, the acceleration of particle P in the 6 frame 
is 
P Pd P 
(a”),, == ((v”)5) (1.33) 


The angular acceleration vector of the B frame relative to the A frame is defined 
to be 


AG 


AB/A = (wea) (1.34) 


Using the definitions in Eqs. (1.26) and (1.32) — (1.34), the particle P accelera- 


tion vector (a? ) A can be written as the useful result? 


(a”) ,= (2%) + (a”) , + Op/A x pt 2wg/a Xx (wv?) 4+ 


WB/A Xx (wpa X Pp) (1.35) 
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The term 2wg 4 X (vo? ) y defines the coriolis acceleration and the term wg/4 x 
(wg JAX p) is the centrifugal acceleration. The latter term can also be expressed 
as 


wpa X (WBA Xx P) = (w/a: P)wB/A — |weyal?pP (1.36) 


which immediately reveals the centripical acceleration vector components along 
wpa and p. Note that Eq. (1.35) holds between any two reference frames. It 
is not necessary that A or BG be inertially fixed. The vector components used in 
the various terms on the right hand side of Eq. (1.35) can be taken along any 
choice of unit vectors. It is important that we recognize the complete freedom 
we have to use any basis vectors we wish to express components of any vector 
in Eq. (1.35). 


Example 1.3: A disk of radius p, attached to a rod of length J, is rolling 
on the inside of a circular tube of radius R as shown in Figure 1.9. The 
rod is rotating at constant rate w = 6. Three different reference frames are 
defined. The inertially fixed frame is V = {O, fi, 2,3} with the origin 
at the center of the tube. The second coordinate frame € = {O, é1, €9, €3} 
has the same origin, but the direction axes track the center of disk O’. The 
third frame B = {O’, b,, bg, b3} has the origin in the center of the disk and 
the direction unit vectors track a point P on the disk edge. Note that ng 
and &é3 point out of the paper and bs = —fi3 points into the paper. What 
is the inertial acceleration 7 of point P expressed in € frame components? 
Note that since three frames are present, we cannot directly use Eq. (1.35). 
Instead the result will be derived by differentiation of the position vector by 
applying the transport theorem. 











Figure 1.9: Disk Rolling inside Circular Tube 


First, let’s determine an expression for relating the angular rates and 6 =w. 
Since there is no slippage between the disk and the tube, then notice that 
the “contact arcs” must be equal on the tube and the cylinder, giving the 
constraint 


OR = op 
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Taking the derivative of the above expression and using 6 = w, the term ¢ is 
given as 


oes 
p 
The angular velocity vectors of frame € relative to NV and frame B relative 
to € are 
We/n = ws 
ane Res 
WB/E = obs = pee 


The angular velocity vector of frame B relative to frame N is 


P wn3 





WB/N = WB/et Wein = — 


The position vector r of point P relative to the origin O is 
r= Lléyp + pb, 
Using the transport theorem in Eq. (1.21), the inertial velocity vector 7 of P 
is 
Ed By f 

f= (Léz) + wey x Lén + > (06,,) + wen x pby 
Note that since L and p are constants for this system, the derivatives within 
the € and BG frames are zero since é, is fixed in € and b, is fixed in B, so 

* =wLég + (R—p)wbg 


The inertial acceleration vector 7 of P is found by taking the derivative of 7 
in the NV frame. 


& By . 7 
r= (wLég)+we sx (wLée) + a (Ca) wbe) +wp/vx((R-p) wb.) 


Since w is constant, the inertial acceleration is then written as the simple 
expression 

i ,  (R-p) » 

r= —w*Lép _ Ges yb: 
To express the inertial acceleration only in unit direction vectors of, for ex- 
ample, the € frame, we eliminate 6, by making use of the identity 


b, = — cos dé, + sin dég 


to obtain the final result 
2 2 
oe (0% =— (R=) 2 cos 6) én — (R=) 2 sin dé9 
p p 


Although the result in Eq. (1.35) can be quite useful at times, when more 
than two frames are present it is typically easier to derive the acceleration 
terms by differentiating the position vector twice as in this example. 
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Problems 


1.1 The particle P moves along a space curve described by the cartesian coordinates 


a(t) = cos(t) 


y(t) = sin(t) 
z(t) = sin(t) 


Describe the given motion in terms of cylindrical and spherical coordinates by 
finding explicit equations for the coordinates. 


1.2 The planar point acceleration vector is given in the cartesian coordinates as 
fr = Le, + Yeo 


Directly transform this vector into polar coordinates r, 0, é, and ég by substi- 
tuting « = rcos@, y =rsin@. Verify the result in Eq. (1.24) obtained through 
the transport theorem. 


1.3 Let a particle P be free to slide radially in a rotating tube as shown in Figure 1.10. 
Assume the tube is rotating at a constant angular velocity w. What is the inertial 
velocity and acceleration of the particle P? Express your answer as functions of 
r, 0, é, and &g. 





Figure 1.10: Particle in Rotating Tube 


1.4 delet N = {O,f1, f2, 73} be an inertial, non-rotating reference frame with its 
center in the center of Earth. The Earth-fixed, equatorial coordinate frame € = 
{O, €1, 62,3} has the same origin, but the unit direction vectors are fixed in 
the Earth. The Earth-fixed, topocentric coordinate frame T = {O’, 0, é, nr} 
tracks a point on Earth as shown in Figure 1.11. Notice the local “geometric” 
interpretation: @ = “up”, € = “east” and nm = “north”. Assuming that a 
stationary person is at a latitude of ¢ = 40 and a longitude of \ = 35", what 
is the inertial velocity and acceleration of the point O’? Express your answer in 
both {7} and {€} components as functions of r, 0, A, ¢ and derivatives thereof. 


1.5 When launching a vehicle into orbit, one typically tries to make use of Earth's 
rotation when choosing a launch site. From what place on Earth would it be the 
simplest (i.e. require least additional energy to be added) to launch vehicles into 
space and how much initial eastward velocity (as seen in an Earth-fixed frame) 
would a vehicle have there thanks to Earth’s rotation? 
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Figure 1.11: Coordinate Frames of a Person on Earth 


1.6 o& The person in Problem 1.4 has boarded a high-speed train and is traveling due 
south at a constant 450 km/h as seen in an Earth-fixed reference frame. What 


is the inertial velocity and acceleration now? 


1.7 


A constantly rotating disk is mounted on a moving train as shown in Figure 1.12. 
The train itself is moving with a time varying linear velocity of v(t). Assume 
the particle P is fixed on the disk, what are its inertial velocity and acceleration? 
Express your answer with {d} components as functions of r, w and v(t). 





Figure 1.12: Rotating Disk on Train 


1.8 Repeat Problem 1.7, but this time assume that the particle P is free to move 
radially on the disk. Again find the corresponding inertial velocity and accelera- 
tion. 
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1.9 


1.10 


Two rotating disks are are arranged as shown in Figure 1.13. Relative to an 
inertial reference frame N’, Disk A has a relative angular velocity ws and 
disk B has a relative angular velocity wy ,;. Each disk has a particle A or 
B respectively fixed to its rim. The orientation of the A frame is given by 
{@r, @t, @3} and the orientation of the B frame is given by {b,., b:, b3}. 

a) What is the relative inertial velocity @ and acceleration #6 of particle B 


versus A? 


b) As seen from particle A, what is the relative velocity and acceleration of 
particle B? 


It is recommended that this problem be solved in two ways: (1) By using 
Eq. (1.35) and (2) by differentiation of the position and velocity vector using 
the transport theorem. 





Figure 1.13: Two Rotating Disks 


Consider the overly simplified planetary system shown in Figure 1.14. The Earth 
is assumed to have a circular orbit of radius R about the sun and is orbiting at a 
constant rate é. The moon is orbiting Earth also in a circular orbit at a constant 
radius r at a constant rate 6. Assume the sun is inertially fixed in space by the 
frame {fi1, 2,3}. Further, a UFO is orbiting the sun at a radius Re at fixed 
rate +. Let the Earth frame E be given by the direction vectors {€,, €4, 3}, the 
moon frame M by {77,-, 79, 73} and the UFO frame U by {t,, ty, &3}. 


a) Find the inertial velocity and acceleration of the moon relative to the sun. 


b) Find the position vector of the moon relative to the UFO. 


) 
c) Find the angular velocity vectors wey and wyy/y. 
) 


d) What are the velocity and acceleration vectors of the moon as seen by the 


UFO frame? 
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Figure 1.14: Planar Planetary System 


1.11 A disk of constant radius r is attached to a telescoping rod which is extending at 
a constant rate as shown in Figure 1.15. Both the disk and the rod are rotating 
at a constant rate. Find the inertial velocity and acceleration of point P at the 
rim of the disk. 





Figure 1.15: Rotating Disk Attached to Telescoping Rod 


1.12 A disk is rolling at a constant rate 6 ona moving conveyor belt as shown in 
Figure 1.16. The conveyor belt speed v is constant. Find the inertial velocity 
and acceleration of Point P. 





Figure 1.16: Disk Rolling on a Conveyor Belt 
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1.13. A vertical disk of radius r is attached to a horizontal shaft of length R as shown 
in Figure 1.17. The shaft is rotating at a time varying rate @. A fixed point P is 
on the rim of the disk, while a missile is flying overhead at a fixed height h with 
the trajectory rm = hn3 — tna. 

a) Find the inertial velocity and acceleration of point P. 


b) What is the velocity and acceleration of point P as seen by the missile. 








Figure 1.17: Grinding Disk 


1.14 Two disks are rotating at constant rates 6 and d a fixed distance L apart as 
shown in Figure 1.18. The radius of the left disk is r and the radius of the right 
disk is R. 


a) What is the inertial velocity and acceleration of point B on the right disk? 


b) As seen from Point A on the left disk, what is the relative velocity and 
acceleration of Point B? 











Figure 1.18: Two Rotating Disks 


1.15 A person A is descending in an elevator at a constant velocity v. A second person 
B is riding a a big wheel of radius R whose center is a distance L away from the 
elevator as shown in Figure 1.19. What is the relative velocity and acceleration 
of person B as seen from person A? 
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Figure 1.19: Person Riding Large Wheel 
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CHAPTER Two 


Newtonian Mechanics 





The previous chapter on Particle Kinematics dealt with vector methods for 
describing a motion. Now we would like to be able to establish complete motion 
models which permit us to solve for the motion once the system forces and 
torques are given. Mass distribution and point of application of forces of a 
dynamical system clearly affect the resulting motion and must be taken into 
account. The motions are found by solving the system equations of motion 
which form the cause/effect model between the forces acting on the system and 
the resulting translational, rotational and deformational accelerations. 

In this chapter, we will first consider the dynamics of a single particle and 
then that of a system of particles. An example of a system of particles would be 
the solar system with the various planets within it idealized as particles. The 
particle mechanics results will then be generalized to derive formulations for 
the dynamics of continuous systems such as vibrating beams or some generally 
deformable collection of matter (such as a bowl of Jello) where the system shape 
may be time varying. 


2.1 Newton’s Laws 


The following laws of nature were discovered by Sir Isaac Newton over 200 years 
ago in England. Later in the early 20th century Albert Einstein theorized that 
these basic laws are only a low-speed approximation in his papers about special 
relativity. However, relativistic effects only become significant when the velocity 
of a particle or body approaches that of the speed of light. In this discussion we 
will assume that all systems studied are moving much slower than the speed of 
light and we will therefore neglect relativistic effects. The following three laws 
are commonly known as Newton’ s laws of motion.+ 3 


Newton’s First Law: Unless acted upon by a force, a particle will maintain 
a straight line motion with constant inertial velocity. 


Newton’s First Law is the most easily overlooked Law because it is a special 
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case of the second law. It simply states that unless something pushes against 
the particle, it will keep on moving in the same direction with constant velocity. 


Newton’s Second Law: Let the vector F be the sum of all forces acting on a 
particle having a mass m with the inertial position vector r. Assume that N is 
an inertial reference frame, then 


Nd 
F= ae (mr) (2.1) 
Or in words, the force acting on m is equal to the inertial time rate of change 
of the particle linear momentum p = mr. If the mass m is constant then this 
results simplifies to the well known result 


F=mi (2.2) 


We observe that if units are not chosen consistent with Eqs. (2.1) and (2.2), 
Newton’s second law requires an additional proportionality factor. Note that 
all derivatives taken in Newton’s Second Law must be inertial derivatives. Since 
it is typically necessary to also describe a position vector in a non-inertial co- 
ordinate frame, the importance of proper kinematics skills becomes apparent. 
Without correctly formulated kinematics, the dynamical system description will 
be incorrect from the start. We mention that a large fraction of errors made in 
practice have their origin in kinematics errors formulating 7 and similar vector 
derivatives. 


Newton’s Third Law: If mass m, is exerting a force Fo, on mass m2, then 
the force F\2 experienced by m, due to interaction with mz will be 


Fy. =—Fy (2.3) 


This conforms to our intuitive experience. Anytime one pushes against an 
object, the reaction force from the object to our hand is an equal force. Be sure 
to keep that in mind when contemplating punching a solid wall, or jumping 
from a canoe. 

In order to write down Newton’s laws, it is important to make use of force 
and moment sketches known as Free Body Diagrams (FBDs). In essence, FBDs 
are used to specify and determine the force vector F in Eq. (2.2). Figure 2.1 is 
an example of a FBD. There are several conventions for free body diagrams, we 
adopt the following rule. The FBD should show all forces and moments acting 
on the system. We exclude from our FBDs acceleration vectors and so-called 
“inertia forces” which are subsets of the m# terms in Eq. (2.2) that may arise 
in rotating coordinate systems. 

Sir Isaac Newton is probably best known for the development of calculus 
and the laws of gravity which by popular account were initiated when an apple 
fell on his head while he was sitting under a tree. However, his laws of motion 
form the foundation of all modern sciences and engineering. 
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Newton’s Law of Universal Gravitation: Let the vector rig = ro — Ty 
describe the position of mass m2 relative to mass m, as shown in Figure 2.1. 
Then the mutually attractive gravitational force between the objects will be 


Gmimz2 12 


Fy) = —Fy = (2.4) 


Iri2|?_ |rie| 


where G & 6.6732 - 10-1 is the universal gravity constant. 


s 





Figure 2.1: Newton’s Law of Universal Gravitation 


For example, this law of universal gravitation allows one to model accurately 
the attractive forces between spacecraft and planets. Note however, that since 
the universal gravity constant G is relatively small, the gravitational attraction 
between two everyday objects such as a house and a car is very small and 
typically ignored. Even Mount Everest makes a barely measurable perturbation 
in the Earth’s total gravitational attraction on objects in the immediate vicinity 
of Mount Everest. 

One important aspect of the law of universal gravitation is that the gravity 
force is conservative and can be calculated from a gravity field potential energy 
function. A general potential energy function V(r) is a scalar function which 
depends on the system position vector r. The potential function measures how 
much work has to be done to the system to move an object from rest a reference 
position ro to rest at position r. A conservative force is defined as a force 
derivable by taking the gradient of a corresponding potential energy function 
V(r) as 


F(r) = -VV(r) (2.5) 


Given V, we can derive F' from the gradient operator as in Eq. (2.5). Given F, 
we can derive V by integration. Note that conservative forces only depend on 
the position vector r and not the velocity vector r or time t. For example, the 


classical viscous drag force F' = —cr would not be a conservative force. 
The gravity potential energy function Vg experienced by the masses m, and 
mg ist 3 
Gm m Gm\mz2 
Ve(rig) = -—_—* = -— (2.6) 


\r12| T12 
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Va(rig) is energy required to separate the two masses from the current distance 
of |ry2| to an infinite separation. We will subsequentially consider (in section 
2.2.3) the relationship of potential energy and work in more detail. Let’s describe 
the rj2 vector through cartesian coordinates as 


ZY 
T12 = v2 (2.7) 
£3 


The magnitude of rj2 is defined as 


lrio| = 1/2? + 03 + 23 (2.8) 


and the partial derivatives of |r12| with respect to the cartesian coordinates x; 
are given by 








O|ria| Xu 
= 2.9 
Ox; \r12| ( ) 
The gradient of the potential field Vg is given by 
OVg = Gm ime O|ria| = Gmymo Li (2 10) 
Ox; |ri2|?_ Ox; lri2|? |rie| 


The gravitational force F; the mass mz experiences due to the mass m, at the 
relative position rj2 is given by 


G i ee G 
Fo = —-VVoe = ee v2 = ee ri (2.11) 
Iri2|? [rie x3 In12| 


Another example of a conservative force is the force exerted by a spring. Let 
the spring have a spring constant k and a linear deflection x. Then its potential 
function Vg is given by 


Vs(x) = sha (2.12) 


The current potential energy indicates how much work was performed to stretch 
the spring from a zero reference deflection state to the deflection x. The force 
exerted by the spring on a mass m is given by the famous Hook’s Law. 


F=-VVq=—ke (2.13) 


Example 2.1: Let us find a first order approximation of the gravity potential 
function in Eq. (2.6) that a body with m would experience near the Earth’s 
surface. Assume a spherical Earth with radius Re and mass me. The radial 
distance r of the body to the center of Earth is written as 


r=R+h 
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where hf is the height above the Earth's surface. The gravity potential expe- 
rienced by the body m due to Earth is 
Vir = _ Gmem 
r 
The function V(r) can be approximated about the distance Re through the 
Taylor series expansion 


1av 
2! Or? 


Lov 
1! Or 


hr... 


Re 


V(r) = V(Re) + 








Re 


The local gravity potential Vicocay uses Re as its reference potential and can 
approximated by 


Vioeat(h) = V(r) = V(Re) = SE] a+ 0H?) 


Re 





After carrying out the partial derivative the local gravity potential function 
for the special case of a constant gravity field is found to be 


Gme 
Viocal (h) = = 





mh = mgh 


where g = G'm-/R? is the local gravitational acceleration. 


2.2 Single Particle Dynamics 


The equation of motion for a single particle is given by Newton’s second law in 
Eq. (2.2) where it is assumed that the particle mass m is constant and # is the 
second inertial derivative of the position vector r. The following two sections 
treat two cases of this simple dynamical system. In the first case the force 
being applied to the mass is assumed to be constant and in the second case it 
is assumed to be time varying. 


2.2.1 Constant Force 


If the force F being applied to the mass m is a constant vector, then the equa- 
tions of motion 


mr = F = constant (2.14) 
can be solved for the time varying position vector r(t). Eq. (2.14) can be solved 


for the inertial acceleration vector 7 as 


#(t) = ~ (2.15) 
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After integrating this equation once from an initial time to to an arbitrary time 
t we obtain the following velocity formulation for mass m. 


*(t) = #(to) + ~ Gea5 (2.16) 


After integrating the velocity formulation an expression for the time varying 
position vector r(t) of mass m is found. 


r(t) = (to) + #(to) (t to) + 5 (t~ to)? (2.17) 


Note that Eqs. (2.15) through (2.17) are actually each three sets of equations 
since r = (@1,%2,73)? and F = (Fi, Fo, F3)" are each three-dimensional vec- 
tors. Given an initial velocity vector r(to), the time required to reach a final 
velocity under constant driving force F' can be solved from Eq. (2.16). 


5 ; m 
(t — to) = (a(t) — 2: (to) EB (2.18) 
i 
Given an initial position vector r(tp), the time required to reach a final position 
vector under constant driving force is found by solving the quadratic equation 
in Eq. (2.17) for the time t. 


Given an initial position and velocity vector and a final position vector, the 
corresponding final velocity vector is found by substituting Eq. (2.18) into 
Eq. (2.17) and solving for 7(t). 








2(E) = 42(to) + 2 (wilt) — multo)) (2.20) 


Example 2.2: The trajectory of a mass m is studied as it travels in a vertical 
plane under the influence of a constant gravitational force F’. Determine an 
equation that relates an arbitrary target location (1, x2) to the corresponding 
launch velocity vo and flight path angle yo. As shown in Figure 2.2, the mass 
is at the coordinate center at time zero with a speed of vo and a elevation 
angle of yo. The cartesian components of the initial position and velocity 
vectors are therefore given by 


r(to) = (3) 7 (to) = vo ) 


Since the gravitational force F’ only acts along the vertical direction, the 
equations of motion are given as 


ro-3(5)-(3 
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Figure 2.2: Ballistic Trajectories under Constant Gravity Force 


where g = F'/m is the local constant gravitational acceleration. Using 
Eq. (2.16) the velocity vector 7(¢) is 


Ho =e (Sn) - Ge) 


The position vector r(t) is found through Eq. (2.17). 


_ fail(t)\ _ cosyo\ [0 
TOS a 3) rag Ge Yo gt?2 
By solving the x1(t) equation for the time t and substituting it into the x2(t) 


equation, one obtains the parabola expression relating x2 to x1 (the equation 
of the path or trajectory): 


2 
gsec yo 2 


v2 = x, tanyo — De ry 


An interesting question now arises. Given an initial speed vo, what would 
the initial elevation angle yo have to be to make the mass m hit a target at 
coordinates (71, Z2)? To answer this we rewrite the above expression relating 
x1 and x2 making use of the trig identity sec” yp = 1+ tan? yo. 


Que 





Qve ry 
tan? yo — 22 tanyo + ne +1 =0 
gX1 gry 


This quadratic equation can be solved explicitly for tan yo. 








2 242 
vO v0 5 2 g? ky 
tan Yo = — + —,/ v2 — 29%2 — 
(tan + Jaye gi gii\\ °° g ve 


If the point (%1, 2) is within the range limit, then this formula will return two 
real answers. One corresponds to a lower trajectory and the other to a higher 
trajectory as illustrated in Figure 2.2. If the point (%1,Z2) is on the range 
limit, then the formula will return a double root. If the real point (#1, 2) is 
outside the range limit, then two complex variables will be returned, indicating 
the reasonable truth that no real solutions exist. 
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Figure 2.3: Ballistic Trajectories under Constant Gravity Force 
To find the envelope of all possible trajectories the case where only double 


roots exist is examined. Setting the square root term to zero, the following 
parabola is found. 


2 
Oe Ae 
aaa 22" 


Any targets that are accessible with the given vo must lie within this parabola. 
The trajectory envelope parabola is shown as a dashed line in Figure 2.2. As 
can be verified, the special case where #1 = 0 gives 2 = v§/2g. You can 
readily show that this is the apogee of a vertically launched projectile with 
launch velocity vo. Another special case where is where Z2 = 0, which provides 
the maximum impact range 11 = vo/g if the surface is flat. Figure 2.3 
compares the various launch angles required to hit a target a distance x1 
away with a given initial velocity v2. For this constant gravity field case, the 
maximum range launch angle is always 45 degrees. Later on this problem is 
revisited in celestial mechanics where the inverse square gravity field case is 
considered. 


2.2.2 Time-Varying Force 


When the force F' acting on the mass m is time varying, then there are typically 
no closed form solutions for the velocity and position vectors. The equations of 


motion are given as 


# = —F(t) 
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Upon integrating Eq. (2.21) from to to t the velocity vector r(t) at time ¢t is 
given as 


#(t) = F(to) + * / F(r)dr (2.22) 


The position vector r(t) is obtain by integrating the velocity vector. 


r(t) = r(to) + r(to) (t— to) + ~ i : F(1™)dtdr2 (2.23) 


Finding the time required to accelerate from one velocity to another or to travel 
from one position to another under the influence of F(t) cannot be found gener- 
ically as for the case of constant F. These results would have to be found 
explicitly for a given problem statement or through a numerical method if no 
closed form solution exists. 


Example 2.3: Let the mass m be restricted to travel only in one dimension. 
It is attached to the coordinate frame origin through a linear spring with 
spring constant k. The force acting on mass m is then given through Hook's 


Law as 
F=-—-kz 
and the equations of motion are then given through Newton's second law in 
Eq. (2.21) as 
1 


i= (—ka) 


This can be rewritten in the form of the standard unforced oscillator differ- 
ential equation. 
m+ kx = 0 


The oscillator problem is known to have a solution of the type 
a(t) = Acoswt + Bsinwt 


Where the constants A, B and w are yet to be determined. The velocity and 
acceleration expressions are then given as 


a(t) = —Awsinwt + Bw coswt 
&(t) = —Aw” coswt — Bw? sinwt = —w? x(t) 
Substituting the expression for %(t) into the equation of motion the following 
expression is obtained 
(—mw? +k) 2 =0 


which must hold for any position x. Therefore the natural frequency w is 


given by* 
[k 
w= a 
m 


The constants A and B would be found through enforcing the solution to 
satisfy the initial conditions x(to) = A and &(to) =wB. 
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2.2.3 Kinetic Energy 


The kinetic energy T of a particle of mass m is given by 
ts A. A 
LS git (2.24) 
To find the work done on the particle we investigate the time derivative of the 
kinetic energy T. 
dT 
After using Eq. (2.14) the kinetic energy rate or power is given as 
ar 
dt 
If the force F’ is conservative it can be expressed as the negative gradient of a 
potential function V. 


F-¢ (2.26) 


dT OV. 


Noting that Vi = & Eq. (2.27) can be written as 


T 


dT dV 
a de 
Therefore the total system energy E = T+ V is conserved. For conservative sys- 
tems it is often convenient to obtain an expression relating coordinates and their 
time derivatives using the system energy. This avoids having to perform difficult 
integrations of the acceleration expressions to obtain the same relationship. 
Let W be the work performed between times t; and tg. Upon integrating 
Eq. (2.26) from time t to tz the following work/energy equation is obtained. 


=0 (2.28) 


te r(t2) 
T(h)-T(h)= / F pdt = i: F-dr=W (2.29) 
ti r(ti) 


Example 2.4: A mass m of 10 kg has an initial kinetic energy of 40 Joules 
(1 Joule = 1 J = 1 kg m?/s? = 1 Nm). A constant force F = 4 N is acting 
on this mass from the initial position r(to) = 0 m to the final position at r(ts 
= 10 m. What is the work done on the mass and what is the final velocity 
at tp? 

Using Eq. (2.29), the work W done to the mass m is 


r(ty) 10m 
w= | Fedr= [ 4N - dr = 40Nm = 40J 
r(t1) Om 


The energy at ty is given by 
T(ts) =T(to) + W = 40J + 40J = 807 
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Using Eq. (2.24) the final velocity (ts) is found to be 


‘GS arts) aay 


2.2.4 Linear Momentum 


The linear momentum vector p of a particle is defined as 
p=mpr (2.30) 


The momentum measure provides a sense of how difficult it will be to change 
a motion of a particle. Assume a locomotive has a large mass m and a very 
small inertial velocity 7. Despite the slow motion, it makes intuitive sense 
that it would be very difficult to stop the motion of this large object. The 
linear momentum p of the locomotive is large due to the large mass. Similarly, 
consider a bullet with a small mass and a very high inertial velocity. Again, 
it makes intuitive sense that it would be difficult to deflect the motion of the 
bullet once it has been fired. In this case the linear momentum of the bullet is 
large not because of its mass, but because of its very large inertial velocity. 

Using the linear momentum definition, we are able to rewrite Newton’s Sec- 
ond Law in Eq. (2.1) in terms of p as 


MG Nd 
F = — (mr) = — 2.31 

=, (me) = = (p) (2.31) 
Thus, the force acting on a particle can be defined as the inertial time rate of 
change of the linear momentum of the particle. If no force is acting on the 
particle, then p is zero and the linear momentum is constant. For the single 
particle system, this is a rather trivial result. However, using the analogous 
arguments on a multi-particle system will yield some very powerful conclusions. 


2.2.5 Angular Momentum 


Let P be an arbitrary point in space with the inertial position vector rp and 
the mass m have an inertial position vector r. The relative position of m to 
point P is given through 


o=Tr-rp (2.32) 


The angular momentum vector Hp of the particle m about point P is defined 
as 


Hp =o x mo (2.33) 
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Taking the time derivative of Hp we find 
Hp=6xme+oxme (2.34) 


After noting that o = 7 — 7p and that a vector cross product with itself is zero, 
the vector Hp is 


Hp=o0xmir-—o xX mrp (2.35) 
Using Eq. (2.14) this is rewritten as 
Hp =o x F+mpxo (2.36) 


Note that the term o x F is the moment (or torque) vector Lp due to force F 
about point P. The angular momentum time derivative can then be written in 
its most general form 


Hp =Lp+mi'p xo (2.37) 


Note that if the reference point P is inertially non-accelerating or r = rp, then 
Eq. (2.37) is reduced to the famous Euler’s equation.) ? 


Hp =Lp (2.38) 


Example 2.5: A weightless cylinder of radius R with a mass m embedded 
in it is rolling down a slope of angle @ without slip under the influence of a 
constant gravity field as shown in Figure 2.4. The mass is offset from the 
cylinder center by a distance J. Let N : {O, a1, M2, 23} be an inertial frame 
and € : {O’, é,, €9, 63} be a rotating frame tracking the point mass within 
the cylinder. Note that é3 = —n3. 








Figure 2.4: Cylinder with Offset Mass Rolling Down a Slope 


The angular velocity vector between the € and the NV frame is 


We/N = 663 = —On3 
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Because of the no slip condition, the distance d that the center of the cylinder 
travels downhill is related to rotation angle @ through 


d= R60 
The position vector r of the point mass relative to O is written as 
r=dni+lé, = ROn, + lé, 


Using the transport theorem, the inertial velocity and acceleration vectors are 
found to be 


* = Rbry + l0éo 
* = ROA, + Wes — 16°E, 
The € frame unit vectors are expressed in terms of V frame components as 


é, = sind@n, + cos On2 


€9 = cosOn, — sinOn2 


The acceleration vector of the point mass m is then expressed in the V frame 
as 


Nit = (RO + 6 cos6 — 16? sin 8) faa — (lO sin + 16” cos) m2 
The forces acting on the rolling cylinder are the gravitational force Fy, 
F, = mg (sin afi — cos anz) 
the normal force N pushing perpendicular from the surface, 
N = Nn 
and the frictional force Fy which is keeping the cylinder from slipping. 
Fy = —Fyr 
Newton's second law states that 
mr = Fi,+ N+ Fs 


After substituting NF and the expressions for the forces into the above equa- 
tion and equating the NV frame components, the following two relationships 
are found. 


m (RO + Lcos 66 — 16? sin 8) =mgsina— Fy 


—m (i sin 06 + 16? cos 0) = —mgcosa+ N 


Once an expression for 6 is found, the second equation could be used to solve 
for the time varying normal force component NV. To solve the first equation 
for the angular acceleration, an expression for the frictional force component 
F's must be found. To do so we examine the angular momentum vector of 
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the point mass about the € frame origin O’. The relative position vector o 
of the point mass to O’ and its inertial derivative are given by 


a=lé, o& =16é 
The angular momentum vector Ho, can then be written as 
Ho: =0 x me = —ml*6n3 
and its inertial derivative is given by 
Ho = —ml?6A3 
The torque Lo, about point O’ is written as 


Lo =o x F, — Riz x (Fy + N) 
= —mglsin (0 + a) 23 — RF ens 


The inertial position vector rg, of point O’ and its second inertial derivative 
are given by 


Tor = dry = ROn, fo: = Rb”, 


Euler’s equation with moments about a general point in Eq. (2.37) is for this 
case 


Ho: =Lo+mro Xo 
which leads to the desired expression for Fy in terms of 6. 
RF; = ml?6 — mglsin (0 + a) + mRI6 cos 6 


Substituting this expression back into the previous equation relating 6 and 
Fy; results in the equations of motion in terms of the rotation angle 0. 


(R? +P 4 2RI cos 0) 6 — RIO? sin@ — gRsina — glsin(@ +a) =0 


This equation could be solved for the angular acceleration 6 which could then 
be used to find the normal force component N purely in terms of 6 and @. 


2.3. Dynamics of a System of Particles 


2.3.1 Equations of Motion 


Until now we have only considered dynamical systems with a single particle. In 
this section we will discuss systems of N particles each with a constant mass 
m,. An example to visualize such dynamical systems would be our solar system. 
To study the translational (orbital) motion of the planets and moons, due to 
the large distances involved, they can usually be considered to be point masses 
with each having different masses m;. 
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Figure 2.5: System of N Particles 


Since we are now dealing with a finite number of masses, we write Newton’s 
second law in index form as 


F,=m,R; (2.39) 


where R; is the inertial acceleration vector of m; as shown in Figure 2.5. The 
force acting on m,; can be broken down into two subsets of forces as 


N 
F,=Fir+ 5) Fy (2.40) 
j=l 
where Fz is the vector sum of all external forces acting on mass m; and Fj; is 


an internal force vector due to the influence of the j-th masses on the 7-th mass. 
The total force vector F' acting on the system of N particles is defined to be 


N N 
P=) => Fs (2.41) 
i=1 w=1 


The internal forces Fj; don’t appear in F' because of Newton’s third law which 
states that Fi; = —Fji, i-e., internal forces cancel in pairs. The total mass WM 
of the N particles is defined as 


M=S om (2.42) 


The system center of mass position vector R, is defined such that 


N 
So mini = 0 (2.43) 
i=1 
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where r; = (R; — R,) is the position vector of m; relative to R,. Thus Eq. (2.43) 
can be rewritten as 


N N 
Som Re = 5 mR; (2.44) 
w=1 i=1 


which is further simplified using the system mass definition in Eq. (2.42) to 
N 
MR. = Y > mR; (2.45) 
i=1 


The center of mass position vector R, is expressed in terms of the individual 
inertial mass position vectors R; as 


N 
1 
Re= 75 2 mR; (2.46) 
After taking two inertial derivatives of Eq. (2.45) we obtain 
oe N. oe NN! 
MR. =) > mRi= >) Fi (2.47) 
i=1 i=1 


After substituting Eq. (2.41) we obtain the final result 
MR. =F (2.48) 


also known as the Super Particle Theorem. The dynamics of the mass center 
of the system of N particles under the influence of the total external force 
vector F' is the same as the dynamics of the “superparticle” M. Note that the 
superparticle theorem only tracks the center of mass motion of the system. No 
information is obtained about the size, shape or orientation of the cloud of N 
particles. 


Example 2.6: Let three masses be connected through springs with a spring 
stiffness constant k as shown in Figure 2.6. The second and third mass each 
are subjected to a constant force where F> = f and F3 = 2f. 


The total system mass is given through 
M=2m+m+m= 4m 
and the total external force F' being applied to the system is 
F=f+2f=3f 
The center of mass of the three-mass system is given found through Eq. (2.45) 


to 


2mr1 + mre+mr3 2ri +7r2+73 
co = [|_| = 


M - 4 
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Figure 2.6: Three-Mass System 


Using the super particle theorem in Eq. (2.48), the equations of motion for 
the center of mass of the three-mass system is 


Ami, = 3f 


Assuming that the r- is originally at rest at the origin, the system center of 
mass location is then integrated to obtain 


3f 42 
nie ar 
To find the equations of motion of the individual masses, we need to write 
Eq. (2.39) for each mass. 
Qmr, = k(r2 —11) 
mrg = —k(re—11) + k(r3 — r2) + f 
mr3 = —k(r3 — r2) + 2f 





This can be written in a standard ODE matrix form for a vibrating system 


2m 0 0 T1 k -k 0 r"1 0 
0 m 0 fo | + )—-k 2k —k T2 — i 
0 0 m T3 0 —k k T3 2f 


which can be solved given a set of initial conditions for r;(to) and 7;(to). 


2.3.2 Kinetic Energy 


The total kinetic energy T of the cloud of N particles can be written as the sum 
of the kinetic energies of each particle. 


N 
1 , , 


After making use of the expression R; = R.+7%;, the total kinetic energy is 
rewritten as 


1(& N LX 
cS . FN Pcie 
5 (>: ) R,-R.+ R. (>: mt) + 5 Ds pr; (2.50) 


wl 
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where the middle term pole m,r; is zero due to the definition of the center of 
mass in Eq. (2.43). The total kinetic energy of a system of N constant mass 
particles m; can therefore be written as 


N 
1 A ‘ 1 : : 
T= gM. Ret 5 es (2.51) 
where the first term contains the system translational kinetic energy and the 


second contains the system rotation and deformation kinetic energy. 
To find the work done on the system we examine the energy rate dT'/dt. 


dT m, 3 a 
Gm MR: Re + 2, mihi Pj (2.52) 


After making use of the facts that MR, = F and that 7; = R;— Rez, the energy 
rate is written as 


dT N . ‘s ye 


i=1 


After using Eqs. (2.39) and (2.43), the energy rate is written in the final form 
as 


dT Bes on See 
—=F.-.R, Fy, 0; 2.54 
a Few y ? (2.54) 


If only conservative forces are acting on m;, then the forces F; can be written 
as the gradient of a potential function V;(7r;). 


Ovi 


hao. (2.55) 





Noting that OViors = V, and defining the total conservative potential function 
to be 


d N 
“v= S-V, 2, 
ae 2 Vi (2.56) 
Eq. (2.54) can be written as 
dT adv . 
Sse eR: 2. 
a + Ai R. (2.57) 


Studying Eq. (2.57) it is clear that for systems where the total applied force 
vector F is zero, the total system energy EF = T'+ V is conserved. If the total 


SECTION 2.3 DYNAMICS OF A SYSTEM OF PARTICLES 43 
resultant force F is itself a conservative force due to a potential function V.(R.), 
then Eq. (2.57) can be written as 


dT x dV ai dv. 
dt dt dt 





=0 (2.58) 


and the total system energy # = T+ V + Vz is also conserved. 

After integrating the kinetic energy rate equation in Eq. (2.54) with re- 
spect to time, the change in kinetic energy between two times is given by the 
work/energy equation 


te « N te 
T(t2) — T(t) =i F- R.dt+ eT F;- pdt (2.59) 
i i=1 741 


1 
which can also be written as the spatial integral 


Re (te r(te) 


) N 
F-dR.+ > [ F,- dr; (2.60) 
ial 


(t1) 


T(t) — T(t1) =| 


R.(t1) 


The first term on the right hand side of Eq. (2.60) is the translational work done 
and the second term is the rotation and deformation work done on the system. 


2.3.3 Linear Momentum 


In Eq. (2.30) the linear momentum p; of a single particle is defined. For a 
system of particles, the total linear momentum of the system is defined as the 
sum 


N 


pe Ye => (miki) (2.61) 


wl 


Let r; be the 7-th particle position vector relative to the system center of mass 
as defined in Eq. (2.43). Taking the derivative of Eq. (2.45), we are able to write 
the total linear momentum expression in Eq. (2.61) in terms of the total system 
mass M and the center of mass inertial velocity vector Re. 


p= MR. (2.62) 


Note that the super particle theorem introduced in Eq. (2.48) also holds for the 
linear momentum of a system of particles. The linear momentum of the mass 
center of the system of N particles is the same as the linear momentum of the 
“superparticle” M. 

Let F; be the force acting on the i-th particle. Note that F; is composed 
both of a net external force component Fj and the inertial force component 
F,; due to interaction with other particles (see Eq. (2.40)). Using the particle 
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equations of motion in Eq. (2.39), the inertial time rate of change of the total 
linear momentum of the particle system is expressed as 


N N 
b= (mk) =) (2.63) 
i=1 i=1 
Since the inertial forces Fj; will cancel each other in this summation due to 
Newton’s third law, the time rate of change of the linear momentum of a particle 
system is equal to the total external force acting on the system. 
Nd 
F=— 2.64 
= (p) (2.64) 


If no external force F is present, then the total system linear momentum vector 
p will be constant. This leads to the important law of conservation of angular 
momentum. Unless an external force is acting on a system of N particles, 
the total linear momentum of the system is conserved. This property is used 
extensively in collision problems or in the rocket propulsion problem. If two 
bodies collide, then energy is used to deform the bodies. The total system 
energy is not conserved during the collision. However, momentum is conserved 
and can be used to compute the velocities of the bodies after the collision. 


Example 2.7: Assume the dynamical system of interest consists of only 
two particles m1; and m2 moving along a one-dimensional, frictionless track 
at different rates. Before a collision at time to they each have a constant 
speed of vi(t> ) and ve(tp ) respectively. The total energy before the impact 
is given by 


_ 1 = 7 
T(to) = 5 (m1v1 (to )” + mava(to )*) 
The total linear momentum is 
P(to ) = mivi(to ) + Mava(to ) 


First, Let assume that the collision is perfectly elastic. In this case any 
energy used to deform the bodies during the collision is regained when the 
body shapes are restored (i.e. think of two rubber balls colliding). Both total 
energy T(t7) 


T(th) = 5 (mini (td)? + moval tS )") 


and momentum p(t?) 





p(tg) = mivi(ty) + mov2(tp ) 


are conserved during the collision. Setting T(tj) = T(t{) and p(t>) = 
p(tt), we are able to express the particles speeds after the collision as 


, 1 








vi(to) = ZF (vr(to )(m1 — ma) + 2va(to ma) 
vat) = 5 (va(te) (me — ma) + 201 (tm) 
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with M = m+ mz being the total system mass. 


Second, we assume that the collision is such that the two particles join and 
become one (i.e. think of two chunks of clay colliding). In this case the total 
energy T(t¢) after the collision is given by 


1 
T(t¢) = gM 


where v is the speed of the joined particles after the collision. The linear 
momentum of the joined particles is 


p(ts) = Mov 


Note that this collision in not perfectly elastic and that energy is not con- 
served. However, linear momentum is conserved and we can set p(tg) = 
p(t¢) to solve for the velocity v of the joined particle after the collision. 


v= = (mivi(to ) + m2v2(t9 )) 


The total energy after the collision is given by 


1 1 _ 
T(t) = gue ~ OM (mivi(to ) + mavo(te))” =— 


The change in energy AT = T(t¢) — T(tj) is given by 


mime 


2M 





NPS (v1 (tg) — v2(to))” 


The energy lost during this plastic collision is used to permanently deform 
the two bodies, as well as to radiate heat and produce sound waves. 


These two examples are idealized situations. In reality the collisions are never 
perfectly elastic or plastic. In this case more knowledge is required about the 
how the bodies will deform to predict the motion after the collision. 


2.3.4 Angular Momentum 


As was done for the case of a single particle, let’s find the angular momentum of 
the N particle system about an arbitrary point P given by the inertial position 
vector Rp. The relative position of each mass m, is given though the vector 


Oo, = R, = Rp (2.65) 


The total system angular momentum vector Hp about the point P is given as 
the sum of all the single particle angular momentum vectors about this point. 


N 


i=l 
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Taking the time derivative of Hp we get 


N N 

i=1 i=l 
After performing similar arguments as in the single particle case this expression 
is rewritten as 


N 


N 
i=1 


wl 


Using Eqs. (2.45), (2.65), the following mass center identity is found. 


N N N 
i=1 i=1 i=1 


The total external moment Lp applied to the system is defined to be 
N . N 
i=l i=l 


Using Eqs. (2.69) and (2.70), the system angular momentum derivative Hp 
about a point P is® 


Hp = Lp + MRp x (R. — Rp) (2.71) 


Note that if either R. = Rp or Rp is non-accelerating inertially, then Eq. (2.71) 
reduces to the most familiar Euler equation 


Hp =Lp (2.72) 


Analogously to the linear momentum development, if no external torque Ep is 
acting on the system of particles, then the total angular momentum rate vector 
Hp is constant. 


Example 2.8: Two particles are attached on strings and are moving in 
a planar, circular manner as shown in Figure 2.7. The plane on which the 
particles are moving is level compared to the gravity field. Thus, given an 
initial velocity and ignoring frictional effects, the particles will continue to 
move at a constant rate. Assume that the two circular paths meet tangentially 
at one point. We would like to investigate how the velocities will change if 
the particles meet at this point at time to. This condition is shown in grey in 
the figure. The total kinetic energy before the collision is 


_ m 7 m _ 
T(to) = ma v1 (to y + mav2(to i 
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Figure 2.7: Illustration of two Particles Moving in a Circular Manner on 
a Level Plane 
while the angular momentum H along the plane normal direction is 
H(to ) = Rimivi (to ) + Remave (to ) 


Assuming the collision is perfectly elastic, then both the total energy and 
angular momentum are conserved. After the collision, we express them as 


m mm 
Rig) = mani (ts)? + FS ma2v2(td)? 





H(tg) = Rimivi (tq) + Rom2v2(t¢ ) 


Setting T(t>) = T(t{) and H(t>) = H(t{), we are able to solve for the 
particle velocities after the collision: 


_ (mi Ri — m2R3)v1 (to ) + 2m2 Ri Reva(to ) 








EN mR? + m2R3 
+, _ 2mi Ri Revi (to) + (m2Ri _ m1R7)ve(to ) 
oa (t ) mR? ae m2R3 


2.4 Dynamics of a Continuous System 


2.4.1 Equations of Motion 


The development of the dynamical equations of motion of a continuous system 
parallels that of the system of N particles. Any finite sums over all particles 
are generally replaced with volume integrals over the body B. This allows us 
to describe any constant mass body, even if it is flexible or does not have a 
constant shape as in a chunk of jello. However, care must be taken to define a 
control volume that contains the instantaneous mass of the system when actually 
carrying out volume integrations. 
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Figure 2.8: Mass Element of Continuous System 


Let dm be an infinitesimal body element with the corresponding inertial 
position vector R as shown in Figure 2.8. Then as such it can be considered to 
be a particle and abides by Newton’s second law. The equations of motion for 
this infinitesimal element are 


dF = Rdm (2.73) 


where dF is the total force acting on dm. The force vector dF is broken up into 
external and internal components as 


dF = dF, + dF, (2.74) 


To express the volume integral over the body 6 let us use the shorthand notation 
Jz = S[fg: The total force F acting on this continuous body is given by 


r= ar= | aFs (2.75) 


where the internal forces again cancel because of Newton’s third law. The total 
body mass is given by 


M= | dm (2.76) 
B 
The system center of mass is defined such that 
| r= (2.77) 
B 


where r = R-— R, is again the internal position vector of dm relative to Re. 
Therefore Eq. (2.77) can be rewritten as 


MR, = i Ram (2.78) 
B 
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The center of mass vector R, is then expressed as 
1 
R.=— | Rd 2.79 
az [| Ram (2.79) 


After twice differentiating Eq. (2.78) we obtain 


MR. = | Ram = [ dF (2.80) 
B B 


After substituting Eq. (2.75) we obtain the equivalent super particle theorem for 
a continuous body. 


MR,.=F (2.81) 


2.4.2 Kinetic Energy 


Let the inertial vector R define the position of the infinitesimal mass element 
dm. The kinetic energy of the entire continuous body B is then given as 


T= >| R-Rdm (2.82) 
2 JB 


After substituting R=R, +7 the kinetic energy is expressed as 


: : : 1 
r=5(/ tim) Re Ret Re f tdm 5 ff #-tam (2.83) 
2\/B B 2 JB 


Making use of Eqs. (2.76) and (2.77), the kinetic energy for a continuous body 
B is written as 


1... . 1 
T= SMR Rot 5 ft rdm (2.84) 
2 2/B 
The first term in Eq. (2.84) represents the translational kinetic energy and the 
second the rotational and deformational energy. 

To find the work done on the continuous body 6 the kinetic energy rate is 
found. 


T Be a 
ayes: f+ | e-em (2.85) 
dt B 
After using Eq. (2.81) and the fact that # = R— R, the kinetic energy rate is 
given as 

dT ’ : a. ie 

Sis Bee: (fam) .¢—R,- | eam (2.86) 

dt B B 
Using Eqs. (2.73) and (2.77) the kinetic energy rate for a continuous, constant 
mass body B is given by 

dT 


ee (2.87) 
dt 2 
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The change in kinetic energy between two times is found by integrating the 
kinetic energy rate expression with respect to time. 


t2 \ ta 
Ta) -T(h) = | F-Reat+ | [ap rat (2.88) 
ti ty B 


This can be also written alternatively as a spatial integration: 


R(t2) r(t2) 
F-dR.+ / , dF - dr (2.89) 
B 


r(t1) 


T(te) —T(ti) = | 

R(t) 
where the first term expresses the translational work and the second term is the 
rotational and deformational work done on the system. 


2.4.3 Linear Momentum 


To determine the total linear momentum of a continuous body 6, we express 
the linear momentum of an infinitesimal body element dm as 


dp = Rdm (2.90) 


Integrating the infinitesimal linear momentum contributions over the entire 
body, the total linear momentum is given by 


p= | a= [team (2.91) 


Using the center of mass property in Eq. (2.78), the total linear momentum of 
the body is written directly in terms of the body mass M and the center of mass 
motion Re. 


p= MR. (2.92) 


Again the super particle theorem applies to the continuous body. The sum 
of the individual infinitesimal linear momenta of the body is the same as the 
linear momenta of a particle of mass M with the same velocity vector as the 
body center of mass motion. Note that the body B is not restricted to be a rigid 
body in this section. If the body center of mass is inertially stationary (i.e. the 
body has zero linear momentum), it is still possible for various body components 
to be moving inertially. For example, consider a heap of jello floating in space. 
It is possible for the jello to be deforming without moving. While the individual 
components of jello might have some linear momentum, the total sum of these 
components cancel each other out to result in a zero net motion of the body 
center of mass. 

Taking the inertial derivative of Eq. (2.92) and making use of the inter- 
nal/external force properties in Eqs. (2.74) and (2.75), we express the total 
linear momentum rate as 


p= | Ram= [ aF=F (2.93) 
B B 
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Thus, the time rate of change of the total linear momentum of a continuous 
body B is equal to the total external force vector being applied to this body. 
If no external is applied, then the total linear momentum is conserved and its 
rate is zero. 


2.4.4 Angular Momentum 


To find the angular momentum vector of the continuous body B about an arbi- 
trary point P, we write the relative position vector o of dm to P as 


o =R-Rp (2.94) 


The total system angular momentum vector Hp about P is then given by 
Hp= i a x adm (2.95) 
Taking the derivative of Hp we get 
Hp = | ax adm+ f ox adm (2.96) 


which can be rewritten as 


Hp =| a x Rdm— (| dm) x Rp (2.97) 
B B 


The term in the brackets can be expanded to 


[eam = [ Ram = (/ am) Rp = M(R. — Rp) (2.98) 


The total external moment Lp applied to the system is defined to be 
Lp= | ox Rim= | ox aF (2.99) 
B B 
Using these two identities in Eqs. (2.98) and (2.99) the system angular momen- 
tum derivative vector Hp about P is 
Hp = Lp + MRp x (R. — Rp) (2.100) 


As was the case with the system of N particles, if either R, = Rp or the 
vector Rp is non-accelerating inertially, then Eq. (2.100) reduces to the Euler 
equation? 


Hp = Lp (2.101) 


As was the case with the dynamical system of finite particles, the angular mo- 
mentum of a continuous body is constant if no external torque vector Lp is 
applied. 
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2.5 The Rocket Problem 


In this section we investigate the thrust that a rocket motor produces by ex- 
pelling propellant at a high velocity from the spacecraft. Consider the one-stage 
rocket shown in Figure 2.9. Let m be the mass of the rocket including any pro- 
pellant that is currently on board. The propellant fuel is being burnt and ejected 
at a mass flow rate of mm. The current velocity vector of the rocket is v, while the 
exhaust velocity of the ejected propellant particles dm relative to the rocket is 
ve. Note that the orientation of the exhaust velocity vector ve does not have to 
point aftward. If the nozzle would be pointing forward, then the engine would 
be used to perform a breaking maneuver. The rocket is assumed to be flying 
through an atmosphere with an ambient pressure P,. At the point where the 
exhaust gases escape the engine nozzle the exhaust pressure is given by Pe. 


Infinitesimal Fuel 
Particle Am 


Rocket Center of 
Mass Motion 


o— 


v 


Thruster Cross Ambient Pressure P 
Sectional Area A 





Figure 2.9: A One-Stage Rocket Expelling a Propellant Particle Am 
with an Ambient Atmosphere pa. 


We would like to develop the thrust vector that the rocket engine is exerting 
onto the spacecraft. To do so, we utilize Eq. (2.72) or (2.101) which state that 
the external force F' exerted onto a system of particles or a continuous body is 
equal time rate of change in linear momentum. Let us treat the rocket mass 
m and the expelled propellant particle Am as a two particle system and track 
their linear momentum change over a small time interval At. Using Eq. (2.72) 
we can write the momentum equation as 


FAt = p(t + At) — p(t) (2.102) 


The quantity F'At is the impulse being applied to the system over the time 
interval dt. At time ¢ is the rocket and propellant mass is still m. At time 
t+ At, the rocket mass has been reduced to m— dm and the propellant particle 
Am is about to leave the engine nozzle. Assume that the only external force 
acting on this two-particle system is due to pressure differential at the engine 
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nozzle. Let A be the nozzle cross sectional area, then the external force F' is 
expressed as 


F=-—A(P.— P,) (2.103) 


F=-—A(P.—P,)+F. (2.104) 


where Fy is the net sum of non-pressure related external forces such as gravi- 
tational forces acting on the system. The pressure induced force is assumed to 
be collinear with the exhaust velocity vector v.. Note that if P, = P. (exhaust 
expands to ambient pressure) or P, = P. = 0 (operating in a vacuum and ex- 
haust expanding to zero pressure), then the net external force on the system is 
zero. Further, if the direction of the exhaust velocity vector v- is in the oppo- 
site direction to the rocket velocity vector v, then a positive pressure differential 
P. — Pa > 0 results in an acceleration in the rocket velocity direction. 
The linear momentum p of the system at time ¢ is 


p(t) = mv (2.105) 


since the propellant particle dm is still joined with the rocket. At time t + At 
the small propellant mass Am is being ejected from the rocket with a relative 
velocity vector ve. Since the rocket is loosing mass, the mass difference Am 
over time dt is a negative quantity. The linear momentum at time t+ At is 


p(t + At) = (m+ Am)(v + Av) — Am(v + ve) (2.106) 


where (m+ Am) is the rocket mass without the escaping fuel particle and Av is 
the change in rocket velocity vector over the time interval At. Dropping higher 
order differential terms in Eq. (2.106) and substituting the F’, p(t) and p(t+ At) 
expressions into Eq. (2.102) leads to 


—72 4(P. — P,) At+ F.At = mAv — Ame. (2.107) 


Ve 


Dividing both sides by At and solving for the acceleration term we find 


Av Ve Am 
aS = — F. 2.1 
m x . A(P. — Pa) + ae vet F. (2.108) 


Allowing the time step At to become infinitesimally small, we arrive at the 
rocket equations of motion: 


ay ee a a ee (2.109) 
dt Ve dt 
a 
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The F, force component is called the static thrust of the rocket engine. If the 
rocket were attached to a test stand, then it would require a force F, to keep 
the rocket immobile during the engine test firing. 

If the exhaust velocity vector is in the opposite direction to the rocket veloc- 
ity vector v as shown in Figure 2.9, and the rocket is operating in a weightless 
environment with F. = 0, then the rocket equations of motion simplify to the 
famous one-dimensional form 

du dm 
n= A(P. — Pa) — Een Fs (2.110) 
with the parameter F’; being the scalar static rocket thrust. Let us assume that 
over a time interval from to to ty that the negative mass flow rate 7m is constant. 
Eq. (2.110) can be rewritten as 
eee (2.111) 
dm 
Rearranging this equation by separating the du and dm terms, and integrating 
from to to ty, we find 


Uf F, mF F, 
vo m m m mf 


mo 


Note that F and m can be taken outside the integral sign since they are con- 
stants in this investigation. The scalar velocity vg is the velocity that the rocket 
possessed at to, while vy is the rocket velocity at the thruster burnout at ty. 
The initial rocket mass is mo and the smaller, final rocket mass is my. The 
burn-out velocity vs can be solve for in terms of the initial rocket velocity and 
mass, as well as the final burnout mass my. 


P, 
vp =p — In (=) (2.113) 


m Mf 


The second term in Eq. (2.113) is a positive quantity since mp > my and the 
mass flow rate m is a negative quantity. Let Am < 0 be the amount of fuel 
mass lost over the given time interval. Then mf = mo + Am. The change in 
velocity Av = vy — vo that results from ejecting Am of fuel is given by 


av = Zin ( ! ) (2.114) 





m 


where ¢ = Am/mo is the ratio of fuel spent over the time interval over the 
initial rocket mass. Note that this change in velocity only depends on the 
amount of fuel spent and F;, not on the length of the burning time. Thus, if a 
thruster produces half the mass flow rate m as another thruster, but burns for 
twice as long, then both thrusters will produce the same velocity change Av. 
However, this result is only true if no other external forces are acting on the 
body. If gravity is pulling on the rocket, then the amount of time spent trying 
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to accelerate the rocket will have a drastic effect on the rocket velocity at burn 
out time. 

A common measure of rocket thruster efficiency is the specific impulse Isp 
defined as*: ° 


Fs 


0 Ging 





(2.115) 


and has units of seconds. The gravitational acceleration g used here is that 
experienced on the Earth’s surface. The higher this J, value is, the more force 
the rocket thruster is able to produce for a given mass flow rate. If the exhaust 
pressure P, is close to the ambient pressure P,, the pressure contribution to the 
static thrust F, in Eq. (2.110) is negligible. In this case F, ~ —mv, and the 
specific impulse simplifies to 
Ve 

LI sp a (2.116) 
From this simplification it is evident that to achieve higher thruster efficiencies, 
the exhaust velocity ve should be as high as possible. The faster a given fuel 
particle is ejected from the rocket, the larger a momentum change (i.e. rocket 
speed up) it will cause. Using the specific impulse definition, the rocket velocity 
change Av for a given fuel ratio € burned is given by 


1 
Av = I,)g1n | —— 2.11 
v= yan () (2.117) 


The specific impulse ranges for different rocket thruster systems are shown in 
Table 2.1.° Note that the higher specific impulse propulsion methods, such as the 
ion or arcjet thrusters, typically produce only a very small thrust. Such modes 
of propulsion are able to achieve a desired Av with a much smaller amount of 
fuel mass Am than a propulsion method with a lower I,,. However, due to the 
small amount of thrust produced, these efficient propulsion methods will take a 
much longer time to produce this desired velocity change. 


Example 2.9: Assume we are trying to launch an initially at rest sounding 
rocket vertically from the Earth’s surface and it is to only fly several miles high. 
For these small altitudes, we are still able to assume that the gravitational 
attraction g is constant during the flight. The solid rocket motor produces a 
constant Is, for the duration of it burn. Since the only external force acting 
on the rocket is the constant gravitational acceleration, the rocket equations 
of motion in the vertical direction are given by Eq. (2.109): 


mo = Fs — mg = g(m — Ispm) (2.118) 


This equation illustrates the challenge that a highly efficient ion propulsion 
system would have in attempting to launch this sounding rocket. The change 
in velocity expression given in Eq. (2.114) assumes that no external forces 
are acting on the rocket except for the ambient and exhaust pressure. With 
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Table 2.1: Specific Impulse and Thrust Ranges for Different Rocket 
Thruster Designs 


Vacuum Thrust 
Thruster Type Isp [sec] Range [N] Comments 
Solid Motor 280 — 300 Simple, reliable low-cost 
design with a low perfor- 
mance, but a high thrust 
Cold Gas 0.05 — 200 Extremely simple and 
reliable design with a 
very low performance 
and heavy weight for the 
small thrust produced 
Liquid Motor 150 — 450 Higher performance 
thruster at the cost of 
a more complicated me- 
chanical and cryogenic 
design 
Electrothermal 450 — 1500 Higher performance, low 
Arcjet thrust system with a 
complicated thermal in- 
terface 
Ion 2000 — 6000 Very high performance 
system with typically a 
very low thrust 





the gravity force acting on our sounding rocket, the thruster is constantly 
battling the gravitational acceleration. In fact, if the rocket thrust is less 
than the weight mg of the rocket, then the propulsion system will not be 
able to lift the rocket off the launch pad. Thus, while a ion high performance 
propulsion system is very effective in accelerating a spacecraft in a weightless 
or free-falling environment, it would be an inappropriate propulsion choice to 
launch a rocket of a planet’s surface. The rocket velocity at burn out time 


ty is then given by 
vp =g (-u 4 Tp ln (=)) (2.119) 
me 


The longer the thruster takes to accelerate the rocket to the desired velocity, 
the longer the thruster must combat the gravitational acceleration. Since the 
efficient ion propulsion system requires a large time t¢ to achieve a desired Av, 
the gravity is also given a large amount of time to counter the achievements 
of the ion thruster. This is why it is common to use solid or liquid chemical 
propulsion systems to launch a rocket from the planet’s surface to a low-Earth 
orbit. While these propulsion choices are less efficient, they provide a thrust 
which is much larger than the rocket weight. With this large static thrust 
the rocket is propelled to the desired velocity quickly and the gravity field has 
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less time to decelerate the craft. 


Problems 

2.1 Plot the magnitude of the gravity force as it varies from Earth’s surface to a 
height of 300 km. 

2.2 Given a spring with a spring stiffness constant of k = 5 kg/s® and a stored 
potential energy of 100 Nm, find the spring deflection x and the force F’ required 
to keep the spring at this deflection. 

2.3 A mass ™ is sliding down a constant slope of 10 degrees with an initial velocity 


of u(to) = 1 m/s. How long will it take this mass to accelerate to a velocity of 
u(t¢) = 10 m/s and what distance will it have traveled? 


2.4 dA skydiver exits an aircraft at an altitude of 3000 m. The aircraft is flying 


horizontally at 36 m/s. The skydiver has a mass m of 80 kg, a forward projected 
surface area A of 0.75 m? and a coefficient of drag ca of 0.555. Assume a uniform 
gravitation field with a gravitational acceleration of 9.81 m/s”. The air density 
p is 1.293 kg/m?. Recall the relationship Drag = dpv'caA, and this force is 
opposite to the velocity vector.° 


a) What is the theoretical terminal velocity of this skydiver? 


b) Find the skydiver equations of motion and solve them numerically for a 45 
second freefall. Plot the altitude versus horizontal position, the skydiver 
speed versus time and the horizontal / vertical velocity versus time. 


c) Taking into account that the more air speed a skydiver has, the better and 
faster the parachute will open, what is the “worst” time for a skydiver to 
try to open the parachute? 


d) How long does it take for the skydiver to reach 95% of the terminal ve- 
locity? 


e) What acceleration does the skydiver experience at terminal velocity? 


f) How far forward does the skydiver get thrown on exit before he or she 
essentially descends vertically? 


4. é 


Point A 


Figure 2.10: Ball in Rotating Tube 
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2.5 A ball of mass m is sliding in a frictionless tube as shown in Figure 2.10. The 
tube is rotating at a constant angular velocity w. Initially the ball is at rest 
relative to the tube at Point A at r = Lé,. 


a) What is the velocity vector when the ball exits the tube? 


b) Up to the point where the ball exists the tube, how much work has been 
performed onto the ball? 


c) Find an expression for the angular momentum vector Ha of the mass m 
about point A. 


2.6 A cannon tries to hit a target which is a distance R away with a projectile of mass 
m as shown in Figure 2.11(i). However, at a distance R/4 there is an obstacle 
of height H present. What is the smallest elevation angle yo and corresponding 
initial speed vo the projectile m must possess initially to hit the target and miss 
the obstacle. Assume a constant gravity field is present. 























0 0 
(i) Clearing an Obstacle (ii) Hitting Elevated Target 





Figure 2.11: Ballistic Trajectory Problems 


2.7 A cannon tries to hit a target which is a distance R away and elevated of the 
ground by a height H with a projectile m as shown in Figure 2.11(ii). What is 
the smallest initial velocity v and corresponding heading angle ¥y the particle may 
have to hit this target. Assume a constant gravity field is present. 


2.8 As shown in Figure 2.12, a ball with mass m is propelled by a spring with a spring 
stiffness k to roll without friction on a surface until it is launched into the air by 
a ramp of height h. The departure angle + is fixed by the ramp and is not a 
variable. The goal is to hit a target on ground level a distance d away from the 
ramp. 


a) Find the initial velocity vo the ball must have when leaving the ramp to 
hit the target. 


b) What is the initial compression z the spring must have such that the mass 
will have the necessary velocity vo when leaving the ramp? 


2.9 Consider the two-particle system studied in Example 2.7. Verify the results shown 
by providing all the algebra required to complete the steps outlined. 
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target 


Figure 2.12: Spring Propelled Mass 


2.10 A massless cylinder is rolling down a slope with an inclination angle a@ under the 
influence of a constant gravity field. A mass m is attached to the cylinder and 
is offset from the cylinder center by R/2 as shown in Figure 2.13. 


a) Find the equations of motion of the the mass m in terms of the angle 0. 


b) What is the normal force N = N*z that the ground is exerting against 
the cylinder. 








Figure 2.13: Rolling Cylinder with Offset mass 


2.11 &A ball m is freely rolling in the lower half of a sphere under the influence of a 
constant gravity field as shown in Figure 2.14. The sphere has a constant radius 
r. Assume that ¢(to) is zero and that O(to), O(to) and d(to) are given. 


a) Find the equation of motion of the ball rolling without slip inside the sphere 
in terms of the spherical angle ¢. Hint: The angular momentum about 
the 13 axis is conserved. 


b) What is the normal force that the wall of the sphere exerts onto the ball 
at any point in time? 


c) Since ¢(to) = 0, the ball is starting out on an extrema. Find an expression 
in terms of 0, 09 and @o that determines the other motion extrema where 


¢=0. Hint: Use conservation of energy. 
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Figure 2.14: Ball rolling inside a Sphere 


2.12 A cloud contains four particles with masses m1 = m2 = 1 and m3 = m4 = 2. 
The position vector of each particle is 


1 —1 2 3 
R,=|-1 Ro = | -3 R3= | -1 Ra=|-1 
2 2 —1 —2 


and their respective velocity vectors are 


. 2 . 0 . 3 . 0 
Ri= 1 Rz=}|-1 R3= | 2 Rsa= 10 
1 1 —1 1 


a) How much of the total cloud kinetic energy is translational kinetic energy 
and how much is rotation and deformation energy? 


b) What is the cloud angular momentum vector about the origin and about 
the center of mass? 


2.13 Two particles with mass m/2 are attached by a linear spring with a spring con- 
stant k& as shown in Figure 2.15. Consider arbitrary initial position and velocity 
of each mass on the plane. For simplicity however, assume that the initial sepa- 
ration 2ro is the unstretched length of the spring, and that the mass center has 
zero inertial velocity initially. 


a) Determine the differential equations of motion whose solution would give 
r(t) and @(t) as functions of time and initial conditions; it is not necessary 
to solve these differential equations. 


b) Determine an expression that relates the radial velocity * and the angular 
velocity 6 as functions of r, @ and initial conditions. 


2.14 A particle of mass ™m is free to sling along a vertical ring as shown in Figure 2.16. 
The ring itself is rotating at a constant rate ¢. 


a) Determine the equations of motion of the particle in terms of 0. 


b) What are the normal forces produced by the ring onto the particle? 
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m/2 ar 


Figure 2.15: Two Masses Moving in a Plane 


OA. % 








Figure 2.16: Particle Sliding Along a Rotating Ring 


2.15 Newton's second Law for a particle of mass m states that F = d/dt(mv). If m 
is time varying, then one might expect F = mv + mv to be true. Explain why 
this logic is incorrect and does not lead to the correct rocket thrust equation. 


2.16 =‘ The static thrust F,, of a rocket is given in Eq. (2.109). Draw a freebody diagram 
of a rocket engine test stand and verify that this is indeed that static force required 
to keep the rocket in place. 
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CHAPTER 2 





CHAPTER THREE 


Rigid Body Kinematics 





TTITUDE coordinates (sometimes also referred to as attitude parameters) 
are sets of coordinates {x1,%2,... ,%n} that completely describe the orien- 

tation of a rigid body relative to some reference coordinate frame. There is an 
infinite number of attitude coordinates to choose from. Each set has strengths 
and weaknesses compared to other sets. This is analogous to choosing among 
the infinite sets of translational coordinates such as cartesian, polar or spherical 
coordinates to describe a spatial position of a point. However, describing the at- 
titude of an object relative to some reference frame does differ in a fundamental 
way from describing the corresponding relative spatial position of a point. In 
cartesian space, the linear displacement between two spatial positions can grow 
arbitrarily large. On the other hand two rigid body (or coordinate frame) ori- 
entations can differ at most by a 180° rotation, a finite rotational displacement. 
If an object rotates past 180°, then its orientation actually starts to approach 
the starting angular position again. This concept of two orientations only being 
able to differ by finite rotations is important when designing control laws. A 
smart choice in attitude coordinates will be able to exploit this fact and produce 
a control law that is able to intelligently handle very large orientation errors. 

The quest for “the best rigid body orientation description” is a very fun- 
damental and important one. It has been studied by such great scholars as 
Euler, Jacobi, Hamilton, Cayley, Klein, Rodrigues and Gibbs and has led to a 
rich collection of elegant results. A good choice for attitude coordinates can 
greatly simplify the mathematics and avoid such pitfalls as mathematical and 
geometrical singularities or highly nonlinear kinematic differential equations. 
Among other things, a bad choice of attitude coordinates can artificially limit 
the operational range of a controlled system by requiring it to operate within 
the non-singular range of the chosen attitude parameters. 

The following list contains four truths about rigid body attitude coordinates 
that are listed without proof.! 


1. A minimum of three coordinates is required to describe the relative angular 
displacement between two reference frames FF; and Fo. 
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2. Any minimal set of three attitude coordinates will contain at least one 
geometrical orientation where the coordinates are singular, namely at least 
two coordinates are undefined or not unique. 


3. At or near such a geometric singularity, the corresponding kinematic dif- 
ferential equations are also singular. 


4. The geometric singularities and associated numerical difficulties can be 
avoided altogether through a regularization.? Redundant sets of four or 
more coordinates exist which are universally determined and contain no 
geometric singularities. 


3.1 Direction Cosine Matrix 


Rigid body orientations are described using displacements of body-fixed refer- 
enced frames. The reference frame itself is usually defined using a set of three 
orthogonal, right-handed unit vectors. For notational purposes, a reference 
frame (or rigid body) is labeled through a script capital letter such as F and 
its associated unit base vectors are labeled with lower case letters such as Fe 
There is always an infinity of ways to attach a reference frame to a rigid body. 
However, typically the reference frame base vectors are chosen such that they 
are aligned with the principal body axes. 

Let the two reference frames NV and B each be defined through sets of or- 
thonormal right-handed sets of vectors {7} and {6} where we use the shorthand 
vectriz notation 


ny e by 
{a}={i2p — {b} = 4 by (3.1) 
12 be 


The sets of unit vectors are shown in Figure 3.1. The reference frame 6 can 
be thought of being a generic rigid body and the reference frame N could be 
associated with some particular inertial coordinate system. Let the three angles 
ay; be the angles formed between the first body vector b, and the three inertial 
axes. The cosines of these angles are called the direction cosines of b; relative 
to the NV frame. The unit vector 6; can be projected onto {7} as 


by = cos ay1h1 + cos aj2n2 + cos a13h3 (3.2) 


Clearly the direction cosines cos a1; are the three orthogonal components of bj. 
Analogously, the direction angles a2; and a3; between the unit vectors bo and 
bs and the reference frame NV base vectors can be found. These vectors are then 
expressed as 


bz = cos Q21%1 + COS A22N2 + COS A23N3 








b3 = cos a31N1 + COS A32h2 + COS A333 (3.4) 
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Figure 3.1: Direction Cosines 


The set of orthonormal base vectors {b} can be compactly expressed in terms 
of the base vectors {7} as 


: CcOSQ@11 COSQ12 COSQ13 
{b} = |cosag1 cosagg cosag3| {nr} = [C]{n} (3.5) 
cos @31 COSQ32 COSQ@33 


where the matrix [C] is called the direction cosine matrix. Note that each entry 
of [C] can be computed through 


Ci; = cos(Z 6;,7;) = b; « n; (3.6) 


Analogously to Eq. (3.5), the set of {#} vectors can be projected onto {b} 
vectors as 


COS Q11 COSQ@21 COSQ@31 . 7 
{nm} = |cosaig cosag, cosa3z| {b} = [C]7 {b} (3.7) 
COS Q13 COSQ23 COSQ33 


Substituting Eq. (3.7) into (3.5) yields 

{b} = [C][C]" {8} (3.8) 
which requires that 

[ClIC]* = [sxs] (3.9) 
Similarly substituting Eq. (3.5) into (3.7) yields 


[C]*[C] = [sx] (3.10) 
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Eqs. (3.9) and (3.10) show that the direction cosine matrix [C] is orthogo- 
nal.!: 3° Therefore the inverse of [C] is the transpose of [C]. 


[o]~* = [c]* (3.11) 


Thanks to the orthogonality of the direction cosine matrix [C], we will see below 
that the forward and inverse transformation (projection) of vectors between 
rotationally displaced reference frames can be accomplished without arithmetic. 

Another important property of the direction cosine matrix is that its de- 
terminant is +1. This can be shown as follows.° From Eq. (3.9) it is evident 
that 





det (CC7) = det ([I3x3]) =1 (3.12) 
Since [C] is a square matrix this can be written as® 
det(C) det(C7) = 1 (3.13) 
Since det(C) is the same as det(C7), this is further reduced to” 


(det(C))” = 1 —> det(C) = +1 (3.14) 





As is shown by Goldstein in Ref. 8, if the reference frame base vectors {6} and 
{7} are right-handed, then det(C) = +1. Goldstein also shows that the 3x3 
direction cosine matrix [C] will only have one real eigenvalue of +1. Again it 
will be +1 if the reference frame base vectors are right-handed. 

In a standard coordinate transformation setting, the [C] matrix is typically 
not restricted to projecting one set of base vectors from one reference frame onto 
another. Rather, the direction cosine’s most powerful feature is the ability to 
directly project (or transform) an arbitrary vector, with components written in 
one reference frame, into a vector with components written in another reference 
frame. To show this let v be an arbitrary vector and let the reference frames B 
and N be defined as earlier. Let the scalars vp, be the vector components of v 
in the B reference frame. 





V = Up, by + Vbqb2 + V54b3 = {vn}? {b} (3.15) 
Similarly v can be written in terms of NV frame components Un, as 
VU = Un, + Unght2 + Unghi3 = {vn} {A} (3.16) 


Substituting Eq. (3.7) into Eq. (3.16) the v vector components in the VV frame 
can be directly projected into the 6 frame. 


vp = [C]vn (3.17) 
Since the inverse of [C] is simply [C]’, the inverse transformation is 


Un = [Cl v% (3.18) 
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The fact that Eqs. (3.17) and (3.18) are exactly analogous to Eqs. (3.5) and (3.7) 
is a fundamental property of Gibbsian vectors, and more generally, cartesian 
tensors. 

Another common problem is that several cascading reference frames are 
present where each reference frame orientation is defined relative to the pre- 
vious one, and it is desired to replace the sequence of projections by a single 
projection. Let {r} contain the base vectors of the reference frame R whose 
relative orientation to the B frame is given through [C’]. 


{#} = [C"]{6} (3.19) 


The basis vectors {71} in the VV frame can be projected directly into the R frame 
through 


{F} = [CIC]{Ar} = [C" {nr} (3.20) 


where the direction cosine matrix [C”] = [C’][C] projects vectors in the NV 
frame to vectors in the R frame. The direct transformation matrix from the 
first to the last cascading reference frame is clearly found by successive matrix- 
multiplications of each relative transformation matrix in reverse order as shown 
above. This property [C”] = [C’][C] for composition of successive rotations is 
very important. When rotational coordinates are introduced to parameterize 
the [C] matrix, the corresponding “composition” relationship among the three 
sets of coordinates is also of fundamental importance. 

The direction cosine matrix is the most fundamental, but highly redundant, 
method of describing a relative orientation. As was mentioned earlier, the min- 
imum number of parameter required to describe a reference frame orientation 
is three. The direction cosine matrix has nine entries. The six extra param- 
eters in the matrix are made redundant through the orthogonality condition 
[C][C|" = [I3x3]. This is why in practice the elements of the direction cosine 
matrix are rarely used as coordinates to keep track of an orientation; instead 
less redundant attitude parameters are used. The biggest asset of the direction 
cosine matrix is the ability to easily transform vectors from one reference frame 
to another. 


Example 3.1: Let the two reference frames B and F be defined relative to 
the inertial reference frame V by the orthonormal unit base vectors 


6, = (0, 1,0)” bo = (1,0,0)7 63 = (0,0,-1)” 
A ae ee A T 
A=(1%80) — fa=(0,0,1)" — f= (8,-4.0) 


where the 6; and fi vector components are written in the inertial VV frame. 
Let us use the following notation to label the various direction cosine matrices. 
The matrix [BN] maps vectors written in the NV frame into vectors written 
in the B frame. Analogously, the matrix [FB] maps vectors in the B frame 
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into F frame vectors and so on. To find the entries of the various relative 
rotation matrices, note the following useful identity. 


[F Bij = COS AiG = fi : b; 


Given the base vectors of each frame, it is not necessary to find the angles 
between each set of vectors to find the appropriate direction cosine matrix. 
Since all base vectors have unit length, the inner product of the correspond- 
ing vectors will provide the needed direction cosines. The rotation matrices 
[BN]iz => b; : N;, [FN]i3 = fi . n; and [F Bi; = fi i b; are 


0 1 0 i @ 0 
[BNJ=]1 0 O| [FNJ=]0 0 1 
0 0 -!1 vB _1 g 
2 2 
ae 

ae 

[FB}=|0 0 -1 

_1 @ 9 

2 2 


Instead of calculating the rotation matrix [FB] from dot products of the 
respective base vectors, it could also be calculated using Eq. (3.20). 


3 
[FB] =[FN][BN]’ = | 0 


pa 
2 


- 0 
OY AL. 7 
V3: =O) 


2s 


wl 


To find the kinematic differential equation in terms of the direction cosine 
matrix [C], let us write the instantaneous angular velocity vector w of the B 
frame relative to the V frame in B frame orthogonal components as 


w= wb; + wabs + w3b3 (3.21) 


Let “d/dt{b} be the derivative of the B frame base vectors taken in the VV 
frame. Using the transport theorem we find? 

NI. Bq. * 

a es b; 3.22 

{8} = {6} + wx {63} (3.22) 
Since the B frame base vectors are fixed within their frame the expression 
54 /dt{b} is zero. After introducing the skew-symmetric tilde matrix operator 


0 —2X3 vg 
[e]= | 73 O 2 (3.23) 
—2X2 Ly 0 


Eq. (3.22) leads to the vectrix equation 


NJ - tok 
apie = IPP} (3.24) 
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Taking the time derivative of the right hand side of Eq. (3.5) we find 


“4 cay = Lucy tay+ic (ay =[eKa} 8.25) 
= (IC{ay) = © (Cy fa} +11 ay) = [Elta ; 


where the short hand notation d/dt([C]) = [C] is used. Using Eq. (3.5), 
Eqs. (3.24) and (3.25) are combined to 


([C] + [&][C1) {A} =0 (3.26) 

Since Eq. (3.26) must hold for any set of {n}, the kinematic differential equation 
satisfied by the direction cosine matrix [C] is found to be! 1° 

[C] = -[aI[C] (3.27) 


It can easily be verified that Eq. (3.9) is indeed an exact solution of above 
differential equation. Take the derivative of [C][C]” 


£ (quer) = eter" + cer" (3.28) 
and then substitute Eq. (3.27) to obtain 
. ([C][C}") = —[a)[Clic]* — [C][c]*1a]* (3.29) 
Making use of the orthogonality of [C] and since [@] = —[@]? is skew-symmetric 
this simplifies to 
© ((CICI) = -1a] + [a] =0 (3.30) 


Since [C][C]* is a constant solution of the differential equation in Eq. (3.27), 
and Eq. (3.9) is satisfied initially, the solution of Eq. (3.27) will theoretically 
satisfy the orthogonality condition for all time. In practice, numerical solutions 
of Eq. (3.27) will slowly accumulate arithmetic errors so that the orthogonality 
condition [C][C]7 — [I3.3] = 0 is slightly in error. There are several ways to 
resolve this minor difficulty. 

Given an arbitrary time history of w(t), Eq. (3.27) represents a rigorously 
linear differential equation which can be integrated to yield the instantaneous 
direction cosine matrix [C]. A major advantage of the kinematic differential 
equation for [C] is that it is linear and universally applicable. There are no 
geometric singularities present in the attitude description or its kinematic dif- 
ferential equations. However, this advantage comes at the cost of having a 
highly redundant formulation. Several other attitude parameters will be pre- 
sented in the following sections which include a minimal number (3) of attitude 
parameters. However, all minimal sets of attitude coordinates have kinematic 
differential equations which contain some degree of nonlinearity and also em- 
body geometric and/or mathematical singularities. Only the once redundant 
Euler parameters (quaternions) will be found to retain a singularity free de- 
scription and possess linear kinematic differential equations analogous to the 
direction cosine matrix. 
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3.2 Euler Angles 


The most commonly used sets of attitude parameters are the Euler angles. They 
describe the attitude of a reference frame BG relative to the frame NV through 
three successive rotation angles (61, 62, 43) about the sequentially displaced body 
fixed axes {b}. Note that the order of the axes about which the reference frame 
is rotated is important here. Performing three successive rotations about the 
3rd, 2nd and Ist body axis, labeled (3-2-1) for short, does not yield the same 
orientation as if instead the rotation order is (1-2-3). Note these sequential 
rotations provide an instantaneous geometrical recipe for VV. Clearly, for B 
undergoing general motion, the 6;(¢) are time varying in a general way. 





Figure 3.2: Yaw, Pitch and Roll Euler Angles 


Aircraft and spacecraft orientations are commonly described through the 
Euler angles yaw, pitch and roll (v,6,¢) as shown in Figure 3.2. They are usually 
measured relative to axes associated with a nominal flight path. The position 
of {b} relative to {7} is described by a sequence of three rigid rotations about 
prescribed body fixed axes. While the conceptual description is a sequence of 
rotations, we can consider the instantaneous values of these three angles and 
thereby establish a means for describing general, non-sequential rotations. The 
popularity of Euler angles stems from the fact that the relative attitude is easy to 
visualize for small angles. To transform components of a vector in the NV frame 
into the B frame through a sequence of Euler angle rotations, the reference axes 
are first rotated about the 63 axis by the yaw angle w, then about the be axis 
by the pitch angle @ and finally about the b; axis by the roll angle ¢ as is shown 
in Figure 3.3. Thus the standard yaw-pitch-roll (w,0,¢) angles are the (3-2-1) 
set of Euler angles.!? 

Another very popular set of Euler angles is the (3-1-3) set of Euler angles. 
These angles are commonly used by astronomers to define the orientation of 
orbit planes of the planets relative to the Earth’s orbit plane.! While the (3-2- 
1) Euler angles are considered an asymmetric set, the (3-1-3) Euler angles are 
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Pitch b 

, _¢ | 3 

fz = b3 a ze 
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Figure 3.3: Successive Yaw, Pitch and Roll Rotations 


a symmetric set since two rotations about the third body axis are performed. 
Instead of being called yaw, pitch and roll angles, the (3-1-3) Euler angles are 
called longitude of the ascending node Q, inclination 7 and argument of the 
perihelion w and are illustrated in Figure 3.4 below.! 1? 

The direction cosine matrix introduced in section 3.1 can be parameterized 
in terms of the Euler angles. Since each Euler angle defines a successive rotation 
about the +th body axis, let the three single-axis rotation matrices [M;(6)] be 
defined as 

1 0 0 

[M1 (0)]} = |0 cos@ sind (3.31a) 
0 -—sin@ cosd 
cosé 0 —sin@ 

[M2(0)}=] 0 1 0 (3.31b) 
sinf 0 cosé 
cos@ sind 0 

[M3(0)] = |—sin@ cosé@ 0 (3.31¢) 
0 0 61 


Let the (a, (3,7) Euler angle sequence be (61, 62,63). Using Eq. (3.20) to 
combine successive rotations, the direction cosine matrix in terms of the (a, 3, 7) 
Euler angles can be written as? 


[C(01, 02, 03)| = [M-,(43)][Moa(92)][Ma(41)] (3.32) 


In particular, the direction cosine matrix in terms of the (3-2-1) Euler angles 
(41, 62, 63) — (w, 0, ?) is 
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Figure 3.4: (3-1-3) Euler Angle Illustration 


n particular, the direction cosine matrix in terms of the (3-2-1) Euler n par- 
ticular, the direction cosine matrix in terms of the (3-2-1) Euler n particular, the 
direction cosine matrix in terms of the (3-2-1) Euler n particular, the direction 
cosine matrix in terms of the (3-2-1) Euler n particular, the direction cosine 
matrix in terms of the (3-2-1) Euler n particular, the direction cosine matrix in 
terms of the (3-2-1) Euler n particular, the direction cosine matrix in terms of 
the (3-2-1) Euler n particular, the direction cosine matrix in terms of the (3-2-1) 
Euler 


cA2cO, cO2801 —sOo 
[C] = 803802c0, = cO3501 80380280, + cO3c0, 803C09 (3.33) 
€03802c0; + 80380, cO3s50280, — s03c0, cO3cOo 


where the short hand notation c€ = cos€ and sé = sin € is used. The inverse 
transformations from the direction cosine matrix [C] to the (w, 0, ¢) angles are 


= 0, = tan™ (=) (3.34a) 
Cy 

d= A = —sin7! (C3) (3.34b) 

o = 63 = tan! (=) (3.34c) 
C33 


In terms of the (3-1-3) Euler angles (0), 02,03) = (Q,7,w) the direction cosine 
matrix [C] is written as! 


cO3cO, = 80300980, cO380, + 803CO2c01 80350 
[C] = | —s63c61 — cO3c8280; —s6380, + cO3CO2c01 C3802 (3.35) 
802804 —sO2c01 cA 
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The inverse transformations from the direction cosine matrix [C] to the (3-1-3) 
Euler angles (Q,i,w) are 





Q = 6, =tan-! ( Cat ) (3.36a) 
—C32 

i = 02 = cos! (C33) (3.36b) 

w = 63 = tan! (=) (3.36c) 
C23 


The complete set of 12 transformations between the various Euler angle sets 
and the direction cosine matrix can be found in the Appendix C. We empha- 
size that while Eqs. (3.32)-(3.36) are easily established by sequential angular 
displacements, we consider the inverse situation; given a generally varying [C] 
matrix, we can consider equations such as Eqs. (3.32)-(3.36) to hold at any 
instant in the motion, and thus {w(t), A(t), d()} or {Q(t), z(t), w(t)} can be 
considered as candidate coordinates for general rotational motion. 

Note that each of the 12 possible sets of Euler angles has a geometric singu- 
larity where two angles are not uniquely defined. For the (3-2-1) Euler angles 
pitching up or down 90 degrees results in a geometric singularity. If the pitch 
angle is +90 degrees, then it does not matter if ~=0 and ¢=10 degrees or w = 
10 and ¢ = 0 degrees. Only the sum w+ ¢ is unique in this case. For the (3-1-3) 
Euler angles the geometric singularity occurs for an inclination angle of zero or 
180 degrees. This geometric singularity also manifests itself in a mathematical 
singularity of the corresponding Euler angle kinematic differential equation. 

Let 0 = {01,602,603} and @ = {¢1, 42,63} be two Euler angle vectors with 
identical rotation sequences. Often it is necessary to find the attitude that cor- 
responds to performing two successive rotations, i.e. “adding” the two rotations. 
If a rigid body first performs the rotation @ and then the rotation @, then the 
final attitude is expressed relative to the original attitude through the vector 
vy = {¥1, 2, 3} defined through 





[FN(¢)] = [FB(P)|[BN(8)] (3.37) 


Eq. (3.37) could be used to solve for y in terms of the vector components 
of @ and @. This process is very tedious and typically does not provide any 
simple, compact final expressions. However, for the case where 0 and @ are 
vectors of symmetric Euler angles, then it is possible to obtain relatively compact 
transformations from the first two vectors into the overall vector using spherical 
geometry relationships.® !8 

A sample spherical triangle is shown in Figure 3.5. The following two spher- 
ical triangle laws are the only two required in deriving the symmetrical Euler 
angle successive rotation property. The spherical law of sines states that 


snA sinB sinC 


sina sin b sin c 











(3.38) 
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(i) Successive (3-1-3) Euler Angles (ii) Spherical Triangle 


Figure 3.6: Illustration of Successive (3-1-3) Euler Angle Rotations 


and the spherical law of cosines states that 


cos A = — cos BcosC' + sin Bsin C cosa (3.39a) 
cos B = — cos AcosC + sin Asin C cos b (3.39b) 
cos C = —cosAcos B + sin Asin B cosc (3.39c) 





Figure 3.6(i) illustrates the orientation of the first body axis as it is first 
rotated from NV to B with the (3-1-3) Euler angle vector @ and then from B 
to F with the (3-1-3) vector @. The (3-1-3) Euler angle description of the 
direct rotation from N to F is clearly given by the angles v1, y2 and y3. To 
obtain direct transformations from @ and @ to ¢, the bold spherical triangle in 
Figure 3.6(i) is used. The spherical arc lengths and angles of this triangle are 
labeled in Figure 3.6(ii). Using the spherical law of cosines we find that 


cos(m — y2) = — cos 62 cos d2 + sin 82 sin d2 cos(43 + d1) (3.40) 
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This is trivially solved for the angle y2 as 
~2 = cos | (cos 62 cos ¢2 — sin 2 sin $2 cos(3 + ¢1)) (3.41) 


Using the spherical laws of sines, we are able to find the following expressions 
for yy and ys: 











sin(y, — 61) = — 2 in(By + 1) (3.42) 
sin ~2 
: sin@) . 
sin(y3 — $3) = an = sin(93 + ¢1) (3.43) 


To avoid quadrant problems, we prefer to find expressions of y; and v3 that 
involve the tan function instead of the sin function. To accomplish this, using 
the spherical law of cosines we find the following two relationships: 


cos @2 — cos 82 cos Y2 


cos(y1 — 61) = (3.44) 


sin 82 sin y2 
cos 62 — cos 2 Cos Y2 


3.45 
sin ¢2 sin Yy2 ( ) 


cos(y3 — ¢3) = 


Combining Eqs. (3.42) through (3.45), we are able to solve for y; and v3 using 
the inverse tan function. 








oc= 6, A pad sin 0 sin 2 sin(43 =r oi) (3.46) 
cos @2 — cos 82 cos ye 
es eal : 4 

Bie pagar erases (3.47) 
cos 82 — cos 2 COs Y2 


Using Eqs. (3.41), (3.46) and (3.47) to solve for @ instead of back-solving y out 
of the direction cosine matrix in Eq. (3.37) is numerically more efficient. While 
the Euler angle successive or composite rotation was developed for the (3-1-3) 
special case, the transformations in Eqs. (3.41), (3.46) and (3.47) actually hold 
for any symmetric rotation sequence.” '? Asymmetric sets, however, will have 
to be composited using the corresponding direction cosine matrices. 

On occasion it is required to find the relative attitude vector between two 
reference frame. For example, given the symmetric Euler angle vectors 8 and », 
find the corresponding vector @ which relates 6 to ¥. Using the same spherical 
triangle in Figure 3.6(ii), we find the following closed form expressions for @. 


_1 (sin 02 sin v2 sin(yi — 91) 
=-6@ t 1 | See eee 3.48 
Or ae ( cos 42 cos d2 — Cos Ye ( ) 
$2 = cos ' (cos 62 cos Y2 + sin 42 sin yz cos(y1 — 41)) (3.49) 
_1 /sin 62 sin ye sin(yi — 01) 
= —t 1 ee 3.50 
$3 = 3 a ( cos 62 — cos $2 Cos Ye ( ) 


Similar expressions can be found to express @ in terms of @ and y. 
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Example 3.2: Let the orientations of two spacecraft B and F relative to 
an inertial frame NV be given through the asymmetric (3-2-1) Euler angles 
O58 = (30, —45, 60)7 and Or = (10, 25,15)” degrees. What is the relative 
orientation of spacecraft B relative to F in terms of (3-2-1) Euler angles. 


The orientation matrices [BN] and [FN] are found using Eq. (3.33). 


0.612372 0.353553 0.707107 
[BN] = |—0.78033 0.126826 0.612372 
0.126826 —0.926777 0.353553 


0.892539 0.157379 —0.422618 
[FN] = |—0.275451 0.932257 —0.234570 
0.357073 0.325773 0.875426 


The direction cosine matrix [BF] which describes the attitude of B relative 
to F is computed by using Eq. (3.20). 


0.303372 —0.0049418 0.952859 
[BF] =[BN][FN]? = |—0.935315 — 0.1895340 0.298769 
—0.182075 —0.9818620 0.052877 


Using the transformations in Eq. (3.34) the relative (3-2-1) Euler angles are 


vb = tan? ( =0:0040418 
0.303372 
9 = —sin ' (0.952859) = —1.26252 deg 


a (02 
é=tan | a) = —57.6097 deg 


) = 0.933242 deg 


0.052877 


Since ¢ is much larger than w and 0, the attitude of B could be described 
qualitatively to differ from F by a —57.6 degree roll. This result was not 
immediately obvious studying the original Euler angle vectors 0g and 0. 


Let the vector w define the instantaneous rotational velocity of the B frame 
relative to the NV frame. To avoid having to integrate the direction cosine matrix 
directly given an w time history, the Euler angle kinematic differential equations 
are needed. The (3-2-1) Euler kinematic differential equation is derived below. 
The methodology can be used for any set of Euler angles. The vector w is 
written in body frame components as 


w= wb; + wobs + w3b3 (3.51) 


From Figure 3.3 it is evident that the B frame rotation can also be written in 
terms of the Euler angle rates (7), 6,6) as 
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The unit vector by, is the direction of the body fixed axis be before performing 
aroll ¢ about b; as is shown in Figure 3.3. It can be written in terms of {b} as 

bs, = cos dbz — sin dbs (3.53) 


The direction cosine matrix in terms of the (3-2-1) Euler angles in Eq. (3.33) is 
used to express 73 in terms of {b}. 


n3 = —sin 6b; +sin cos Ob2 + cos cos 0b; (3.54) 


After substituting Eqs. (3.53) and (3.54) into Eq. (3.52) and then comparing 
terms with Eq. (3.51), the following kinematic equation is found. 


Ww —sind 0 1) /¢ 
wo | = |sindcos@ cosh 0} | A (3.55) 
ws cospcos#@ —sing 0} \¢ 


The kinematic differential equation of the (3-2-1) Euler angles is the inverse of 
Eq. (3.55). 





b 1 0 sin @ cos & Wy 
over 0 cosdcosé —singdcosé} | wo} =[B(y,0,¢)]w (3.56) 
d COS” |cos@ sin gsind cos@sin#é W3 


Similarly, the kinematic differential equations for the (3-1-3) Euler angles are 
found be 


sinO3sin@2  cos@3 0 A 
w= |cosé3sinf2 —sin63 O| | @> (3.57) 
cos A 0 1 63 


with the inverse relationship 





b 1 sin 03 cos 63 0 
Bae | 8 63sin@2  —sin@3sin 02 0 | w=[B(O)|w (3.58) 
63 SIN Y2 | _ sin @3cos0. —cos63cos6. sin b> 


The complete set of 12 transformations between the various Euler angle rates 
and the body angular velocity vector can be found in Appendix C. Note that 
the Euler angle kinematic differential equations encounter a singularity either 
at 62 = +90 degrees for the (3-2-1) set or at 62 = 0 or 180 degrees for the (3-1-3) 
set. It turns out that all Euler angles sets encounter a singularity at specific 
second rotation angle 92 only. The first and third rotation angles 0; and 63 
never lead to a singularity. In all cases, it can be verified that the singularity 
occurs for those 62 values that result in 6; and 63 being measured in the same 
plane. If the Euler angle set is symmetric, then the singular orientation is at 
62 = 0 or 180 degrees. If the Euler angle set is asymmetric, then the singular 
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orientation is 62 = +90 degrees. Therefore asymmetric sets such as the (3-2-1) 
Euler reference frame. Symmetric sets as the (3-1-3) Euler angles would not be 
convenient to describe small departure rotations of {6} from the {7} axes since 
for small angles one would always operate very close to the singular attitude at 
02 = 0. 

The Euler angles provide a compact, three parameter attitude description 
whose coordinates are easy to visualize. One main drawback of these angles 
is that a rigid body or reference frame is never further than a 90 degree rota- 
tion away from a singular orientation. Therefore their use in describing large, 
arbitrary and especially arbitrary rotations is limited. Also, their kinematic 
differential equations are fairly nonlinear, containing computationally intensive 
trigonometric functions. The linearized Euler angle kinematic differential equa- 
tions are only valid for a relatively small domain of rotations. 


3.3. Principal Rotation Vector 


The following theorem has been very fundamental in the development of several 
types of attitude coordinates and is generally referenced to Euler.!* 1° 


Theorem 3.1 (Euler’s Principal Rotation) A rigid body or coordinate ref- 
erence frame can be brought from an arbitrary initial orientation to an arbitrary 
final orientation by a single rigid rotation through a principal angle ® about the 
principal axis €; the principal axis being a judicious axis fixed in both the initial 
and final orientation. 





Figure 3.7: Illustration of Euler’s Principal Rotation Theorem 


SECTION 3.3 PRINCIPAL ROTATION VECTOR 79 


This theorem can be visualized using Figure 3.7. Let the principal axis unit 
vector é be written in B and NV frame components as 
& = ey, by + eb,b2 + ebab3 (3.59a) 


é= Cn, M1 + Eng te + Eng hs (3.59b) 


Implicit in the theorem we see that é will have the same vector components in 
the B as in the N reference frame; i.e. e,, = en, = ei. Eq. (3.5) shows that 


ey El 
e€2 = [C] €2 (3.60) 
€3 €3 


must be true. Therefore the principal axis unit vector é is the unit eigenvector 
of [C] corresponding to the eigenvalue +1. Thus the proof of the Principal 
Rotation Theorem reduces to proving the [C] has an eigenvalue of +1. This 
proof is given in Goldstein in Ref. 8. The eigenvalue +1 is unique and the 
corresponding eigenvector is unique to within a sign of ® and é, except for the 
case of a zero rotation. In this case [C] = [I3x3] and ® would be zero, but there 
would be an infinity of unit axes é such that é = [J3.3]é. For the general case, 
the lack of sign uniqueness of ® and é€ will not cause any practical problems. 
The sets (é,®) and (—é, —®) both describe the same orientation. 





Figure 3.8: Illustration of Both Principal Rotation Angles 


The principal rotation angle ® is also not unique. Figure 3.7 shows the 
direction of the angle ® labeled such that the shortest rotation about é will be 
performed to move from N to B. However, this is not necessary. If so desired, 
one can also rotate in the opposite direction by the angle ®’ and achieve the 
exact same orientation as shown in Figure 3.8. The difference between ® and ®’ 
will always be 360 degrees. In most cases the magnitude of ® is simply chosen 
to be less than or equal to 180 degrees. 

To find the direction cosine matrix [C] in terms of the principal rotation 
components é and ®, the fact is used that each reference frame base vector n; 
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Figure 3.9: Mapping n; into b; Base Vectors 
is related to 6; through a single axis rotation about é. Let the unit principal 
axis vector be written as 
é€ = e1n, + €2N2 + €3h3 (3.61) 


and let €; be the angle between n; and é as shown in Figure 3.9. Let’s note the 
following useful identity 


é- fi; = cos&; = ej (3.62) 
Studying Figure 3.9 the base vector b; can be written as 
b; = cos €;é + sin €;a' = e,é + sin 0 (3.63) 
The unit vector @’ is given by 
a’ = cos ®& + sin &b (3.64) 


It follows from the geometry of the single axis rotation that 


ex n; 1 
p= 2 __éx tiy 3.65 
Cea nee 02) 
fn Ae Sa get wall 2 ihe oni , 
MOS ae éx nj) x é (3.66) 


The expression for t can be further reduced by making use of the triple cross 
product identity 


ax (bx c)=(a-c)b—(a-b)c (3.67) 


to the simpler form 


a2 = (A; —€,8) (3.68) 
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After substituting Eqs. (3.64), (3.65) and (3.68) into Eq. (3.63), each base vector 
b; is expressed in terms of reference frame N base vectors. 

b; = cos ®f; + (1 — cos) 667 A; + sin ® (é x fj) (3.69) 


where €é” is the outer vector dot product of the vector €. Making use of the 
definition of [é] in Eq. (3.23) the set of base vectors {b} can be expressed as 


{b} = (cos ®[I33] + (1 — cos ®) é€? — sin &[é]) {A} (3.70) 


Using the relationship {6} = [C]{”}, the direction cosine matrix can be directly 
extracted from Eq. (3.69) to be 





py +c® ej€gu + e3s® e1€3d) — e950 
[C] = | e2e1h — e350 e2+ c® e2€3h + €1s® (3.71) 
€3€;: + eos e3e9d; — e1s® e3) +c® 





where © = 1 —c®. Again the short hand notation cb = cos® and s® = sin ® 
was used here. The direction cosine matrix [C] depends on four scalar quantities 
€1,€2,e3 and ®. However, only three degrees of freedom are present since the 
vector components e; must abide by the unit constraint ae eel: 

By inspection of Eq. (3.71), the inverse transformation from the direction 
cosine matrix [C] to the principal rotation elements is found to be 





1 
cos ® = 5 (Cy + Co2 + C33 — 1) (3.72) 
ey 1 Co3 — C32 
é= €2 = and C31 i C13 (3.73) 
€3 a Ci2 — Cr 


Note that Eq. (3.72) will yield a principal rotation angle within the range 0 < 
® < 180 degrees. The direction of é in Eq. (3.73) will be such that the principal 
rotation parameterizing [C] will be through a positive angle ® about é. To find 
the second possible principal rotation angle ©’ one subtracts 360 degrees from 
®, 


0 = 6-27 (3.74) 


The angle ®’ is equally valid as ® and yields the same principal rotation axis 
é. The only difference being that a longer rotation (for |®| < 7) is being per- 
formed in the opposite direction. As with the sequential Euler angle rotations, 
the instantaneous principal rotation parameters {e1(t), e2(t), e3(t), ®(t)} can be 
considered coordinates associated with the instantaneous direction cosine ma- 
trix [C(€)], and obviously does not restrict the body to actually execute the 
principal rotation. 


Example 3.3: Let the B frame attitude relative the VV frame be given by the 
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(3-2-1) Euler angles (10,25,-15) degrees. Find the corresponding principal 
rotation axis and angles. 


Using Eq. (3.33) the direction cosine matrix [BN] is 
0.892539 0.157379 —0.422618 
[BN] = | —0.275451 0.932257 —0.234570 
0.357073 0.325773 0.875426 


The first principal rotation angle ® is found through Eq. (3.72). 
-ifil 0 
© =cos’ (5 (0.892539 + 0.932257 + 0.875426 — 1)) = 31.7762 


The corresponding principal rotation axis is given though Eq. (3.73). 


: 0.23457 — 0.325773 0.532035 
é = ——___ | 0.357073 — (—-0.422618) | = | 0.740302 
2 sin (31.7762°) \ 9 157379 — (—0.275451) 0.410964 


The second principal rotation angle ®’ calculated using Eq. (3.74). 
6’ = 31.7762° — 360° = —328.2238° 


Either principal rotation element sets (é, ®) or (é, ®’) describes the identical 
attitude as the original (3-2-1) Euler angles. 


Many important attitude parameters that are derived from Euler’s principal 
rotation axis é and angle ® can be written in the general form 


p= f(®)é (3.75) 


where f(®) could be any scalar function of ®. All these attitude coordinate 
vectors have the same direction and differ only by their magnitude |p| = f(®). 
The principal rotation vector -y is simply defined as 


y= 6 (3.76) 


Therefore the magnitude of y is f(®) = ®. This attitude vector has a very 
interesting relationship to the direction cosine matrix that can be verified to 
also hold for higher dimensional orthogonal projections as shown in Ref. 17. To 
gain more insight, consider the special case of a pure single-axis rotation about 
a fixed é€ with the rotation angle being 6. The angular velocity vector for this 
case is 


w= 66 (3:77) 
or in matrix form: 


[a] = [é] (3.78) 
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Substituting Eq. (3.78) into Eq. (3.27) leads to the following development: 


d(C] d® 
ae ele [C] 
aC) ae 
aS —le}[C] 
ij=e*a (3.79) 


The last step holds true for [é] being a constant matrix for a rotation about a 
fixed axis. Due to Euler’s principal rotation theorem, however, any arbitrary 
rotation can be instantaneously described by the equivalent single-axis rotation. 
Euler’s theorem means that Eq. (3.79) holds at any instant for an arbitrary time 
varying direction cosine matrix [C]. Note for time-varying [C], however, that é 
and ® must be considered time-varying. Using Eq. (3.76) the rotation matrix 
[C] is related to -y through 


es ea) (3.80) 
n=0 

It turns out that this mapping also holds for higher dimensional proper orthogo- 

nal matrices [C]. For the case of three-dimensional rotations, the infinite power 

series in Eq. (3.80) can more conveniently be written as a finite, closed form 

solution.® 1” 


[C] = e~ Pl = [13,3] cos & — sin G[é] + (1 — cos ®) 6 (3.81) 


To find the inverse transformation from [C] to -y, the inverse matrix logarithm 
is taken. 


Co 


Z 1 n 
1 = -In[C] = D> = - [c1) (3.82) 
n=0 
This inverse mapping is defined everywhere except for 6 = 0 and ® = +180 





degree rotations. For these rotations, the non-uniqueness of the yy vector that 
leads to mathematical difficulties. Otherwise a vector 7+ is reliably returned 
corresponding to a principal rotation of less than or equal to 180 degrees. 


Example 3.4: In Example 3.3 it was shown that the direction cosine matrix 


0.892539 0.157379 —0.422618 
[BN] = |—0.275451 0.932257 —0.23457 
0.357073 0.325773 0.875426 


represents the equivalent orientation as the principal rotation vector 


—0.532035 —0.295067 
7 = 0.55460rad 0.740302 | = 0.410571 


0.410964 0.227921 
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To verify the mapping in Eq. (3.80) let’s write [4] using the definition of tilde 
matrix operator in Eq. (3.23). 


0 —0.227921 0.410571 
] = | 0.227921 0 0.295067 
—0.410571 —0.295067 0 


Using software packages such as Mathematica or MATLAB, the matrix expo- 
nential mapping in Eq. (3.80) can be solved numerically for the corresponding 
direction cosine matrix [BN]. 


; 0.892539 0.157379 —0.422618 
[BN] =e" = | 0.275451 0.932257 —0.234570] / 
0.357073 0.325773 0.875426 


Let (®1, €1) be the principal rotation elements that relate the B frame rela- 
tive to the N frame, while (®2, €2) orients the F frame relative to the B frame. 
The F frame is related directly to the NV’ frame by the elements (®, é€) through 
the relationship 


[FN(®, €)] = [FB(®2, €2)|[BN (1, €1)] (3.83) 
Instead of solving for the overall principal rotation elements through the cor- 


responding direction cosine matrix, it is possible to express (®, é) directly in 
terms of (1, €,) and (®2, é2) through® 


®, ® ® ® 
& =2cos! (cos > 008 7 — sin sin = és) (3.84) 
do fis ®) Bos ® ®o 
cos sin = é, + cos = sin €) + sin = sin é€, x é 
{= — oe ee eee eee (3.85) 


® 
sin z 


This composite rotation property is easily derived from the Euler parameter 
composite rotation property shown in the next section. Given the two principal 
rotation element sets (®1, €;) and (®, é), the relative orientation set (®2, é2) is 
expressed similarly through 


® ® ® ® 
®, = 2cos! (cos = cos os + sin 5 sin =e -é1) (3.86) 
cos $ sin $6 — cos $ sin S+é; + sin sin Bé x é 
€) = a ay (3.87) 


The kinematic differential equation of the principal rotation vector ‘+ is given 
by® 18-20 


4 = |[Iexa] + sii + a (1 ~ F cot ()) ar w (3.88) 
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where ® =|| ¥ ||. The inverse transformation of Eq. (3.88) is 


w= {lel -(=S*) + (*)r]y so) 


As expected, the kinematic differential equation in Eq. (3.88) contains a 0/0 type 
mathematical singularity for zero rotations where 6 = 0 degrees. Therefore, the 
principal rotation vector is not well suited for use in small motion feedback con- 
trol type applications where the reference state is the zero rotation. Further, 
the mathematical expression in Eq. (3.88) is rather complex, containing poly- 
nomial fractions of degrees up to three in addition to trigonometric functions. 
This makes + less attractive to describe large arbitrary rotations as compared 
to some other, closely related, attitude parameters that will be presented in the 
next few sections. 


Example 3.5: Given the prescribed body angular velocity vector w = w(t)é 
for a single axis rotation, Eq. (3.88) yields the following kinematic differential 
equation for the principal rotation vector 7 = ®é. 


; ® 1 ® ® 2a 12 5 
¥ = |[sxs] - al + $e ¢ Se Ot (3)) ®*/F] w(t)é 
Noting that [y]é = ®[é]é = 0, this is simplified to 


¥y=w(té 


Therefore the general expression in Eq. (3.88) simplifies to the single axis 
result in Eq. (3.77). 


The principal rotation elements é and ® have had a fundamental influence on 
the derivation of many sets of attitude coordinates. All of the following attitude 
parameters will be directly derived from these principal rotation elements. 


3.4 Euler Parameters 


Another popular set of attitude coordinates are the four Euler parameters 
(quaternions). They provide a redundant, nonsingular attitude description and 
are well suited to describe arbitrary, large rotations. The Euler parameter vector 
B is defined in terms of the principal rotation elements as 


Bo = cos (®/2) 

Gy = e1 sin (®/2) 
(G2 = eg sin (®/2) (3.90 
33 = e3 sin (®/2) (3.90d 
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It is evident since e? + e} + e2 = 1, that the (;’s satisfy the holonomic constraint 
5 + Bf + 83 + 83 =1 (3.91) 


Note that this constraint geometrically describes a four-dimensional unit sphere. 
Any rotation described through the Euler parameters has a trajectory on the 
surface of this constraint sphere. Given a certain attitude, there are actually 
two sets of Euler parameters that will describe the same orientation. This is due 
to the non-uniqueness of the principal rotation elements themselves. Switching 
between the sets (é, ®) and (—é, —&) will yield the same Euler parameter vector 
(3. However, if the second principal rotation angle ®’ is used, another Euler 
parameter vector @’ is found. Using Eq. (3.74) one can show that 


(Bo = COS (=) = cos (5 oat n) = — cos (5) = —fo 
6; = ex sin (5) = e; sin (+ = r) =—e,sin (5) =—; 


Therefore the vector 3’ = —G describes the same orientation as the vector 
B. This results in the following interesting observation. Since any point on 
the unit constraint sphere surface represent a specific orientation, the anti-pole 
to that point represents the exact same orientation. The difference between 
the two attitude descriptions is that one specifies the orientation through the 
shortest single axis rotation, the other through the longest. From Eq.(3.90a) it 
is clear that in order to choose the Euler parameter vector corresponding to the 
shortest rotation (i.e. |®| < 180 degrees), the coordinate 69 must be chosen to 
be non-negative. 
Using the trigonometric identities 


sin ® = 2sin (®/2) cos (®/2) 
cos ® = 2 cos” (®/2) — 1 


in Eq. (3.71), the direction cosine matrix can be written in terms of the Euler 
parameters as 


(6 +07-63-B3 2(G182+ 8083) 2(G183 — BoB) 
[C] = | 2 (6182-063) 6§-G?+63-B3 2 (6263 + BoG1) (3.92) 
2 (8183 + BoB2) 2(6283—B8081) 63-82 — 634+63 


The fact that G and —G produces the same direction cosine matrix [C] can be 
easily verified in Eq. (3.92). All Euler parameters appear in quadratic product 
pairs, thus changing the signs of all 3; components has no effect on the resulting 
[C] matrix. It is evident that the most general angular motion of a reference 
frame generates two arcs on the four dimensional unit sphere (the geodesic arcs 
generated by G(t) and —G(t)). This elegant description is universally nonsin- 
gular and is unique to within the sign +G(t). The inverse transformations from 
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[C] to the Euler parameters can be found through inspection of Eq. (3.92) to 
be 





1 
Bo = t5V Cy + Co2 + C33 +1 (3.93a) 


_ C23 — C2 
eer (3.93b) 
2 Cars 
pq = — ti (3.93c) 
Cio — Car 
= a (3.93d) 


Note that the non-uniqueness of the Euler parameters is evident again in this 
inverse transformation. By keeping the + sign in Eq. (3.93a) one restricts the 
corresponding principal rotation angle ® to be less than or equal to 180 degrees. 
From a practical point of few this non-uniqueness does not pose any difficulties. 
Initially one simply picks an initial condition on one Euler parameter trajec- 
tory and then remains with it either through solving an associated kinematic 
differential developed below, or using elementary continuity logic. 

Clearly Eq. (3.93) has a 0/0 type mathematical singularity whenever 9 — 0. 
This corresponds to the @ vector describing any 180 degree principal rotation. 
A computationally superior algorithm has been developed by Stanley in Ref. 21. 
First the the four 3? terms are computed. 





63 = + (1 + Trace{C\) (3.94a) 
a= : (1+ 2C\1 — Trace[C]) (3.94b) 
6B = + (1 + 20x ~ Trace{C) (3.94c) 
pe= ; (1 + 2C33 — Trace[C}) (3.94d) 


Then Stanley takes the square root of the largest 3? found in Eq. (3.94) where 
the sign of (; is arbitrarily chosen to be positive. The other (@;’s are found by 
dividing the appropriate three of the following six in Eq. (3.95) by the chosen 
largest 3; coordinate. 


BoP1 = (C23 — C'32)/4 (3.95a) 
Bo Bo = (C31 — Ci3)/4 (3.95b) 
BoP3 = (C12 — Co1)/4 (3.95c) 
3283 = (Co3 + C32)/4 (3.95d) 
3301 = (C31 + Ci13)/4 (3.95e) 
(182 = (Cig + Car) /4 (3.95f) 





To find the alternate set of Euler parameter, the sign of the chosen 3; would 
simply be set negative. 
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Example 3.6: Let's use Stanley's method to find the Euler parameters of 
the direction cosine matrix [C]. 


0.892539 0.157379 —0.422618 
[C] = | —0.275451 0.932257 —0.234570 
0.357073 0.325773 0.875426 


Using the expressions in Eq. (3.94) the absolute values of the four Euler 
parameter are found. 


G6 = 0.925055 G7 = 0.021214 
G3 = 0.041073 (3 = 0.012657 


The { term is selected as the largest element and used in Eqs. (3.95a) 
through (3.95c) to find the Euler parameter vector. 


3 = (0.961798, —0.14565, 0.202665, 0.112505)” 


The alternate Euler parameter vector would be found be simply reversing the 
sign of each element in 3. 


A very important composite rotation property of the Euler parameters is the 
manner in which they allow two sequential rotations to be combined into one 
overall composite rotation. Let the Euler parameter vector @’ describe the first, 
8” the second and 3 the composite rotation. From Eq. (3.20) it is clear that 


[FN (B)] = [FB(B")|[BN(8)] (3.96) 


Using Eq. (3.92) in Eq. (3.96) and equating corresponding elements leads to 
following elegant transformation that bi-linearly combines 3’ and 8” into B. 


B Mo QW —pY 1 
0 0 1 2 3 0 
pr fl 0 3 —BZ 1 
B — 11 — Ru vt 11 / (3.97) 
2 2 3 0 1 2 
B 11 V1 — Ru 11 / 
3 3 2 1 0 3 


By transmutation of Eq.(3.97) an alternate expression 3 = [G(G’)]B” is found 


Bo Po —B, —B —B3 0 
pi PB, Bo —B3 Ba} | BY (3.98) 


Bo} |B = 3 By — Bi] | Be 
(3 Bs —Bo Br Bo} \B3 


where the components of the matrix [G(@’)] are given in Eq. (3.98). Note the 
useful identity 


[G(8)|"B = (3.99) 


ooOorF 
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By inspection, it is evident that the 4x4 matrices in Eqs. (3.97) and (3.98) are 
orthogonal. These transformations provide a simple, nonsingular and bilinear 
method to combine two successive rotations described through Euler parame- 
ters. For other attitude parameters such as the Euler angles, this same compos- 
ite transformation would yield a very complicated, transcendental expression. 


Example 3.7: Using Stanley's method, the direction cosine matrices [BN] 
and [FB] defined in Example 3.1 can be parameterized through the Euler 
parameter vectors 3’ and 3” respectively as 


[BN] > p= (0, 45, 25.0)" 


T 
FB Wf lf 44 1 /vB 4 v2 v2 
eB er oa (aV¥e1. aV2 + Gh alas 


Note that the vector 3’ describes the attitude of the B frame relative to the 
N frame, while the vector 3” describes the F frame attitude relative to the B 
frame. Eq. (3.97) can be used to combine the two successive attitude vectors 
into one vector 8 which directly describes the F frame orientation relative to 


the NV frame. ‘ - 
B= wW/2 (v3, v3,1,1) 


To verify that G does indeed parameterize the direction cosine matrix [FN] 
given in Example 3.1, it can be back substituted into Eq. (3.92) to yield 








J3 1 
Va Jo 
NS io Oo cet], ke 
1 
5 4 O 


The kinematic differential equation for the Euler parameters can be derived 
by differentiating the @;’s in Eq. (3.93). The following development will es- 
tablish the kinematic equation for Go only, the remaining 8; equations can be 
developed in an analogous manner. After taking the derivative of Eq. (3.93a), 
Bo is expressed as 


= Cu + Coa + C33 
860 


After using the expressions for Cj; given in Eq. (3.27), the term Bo is rewritten 
as 


Bo (3.100) 


, lf Cr — Coe Cai Cis Cig — Car 
SS | Se eS pe ee 101 
Bom 9 (Sg ten tn Sn) at 
Using Eqs. (3.93b) through (3.93d), the Go differential equation is simplified to 
. 1 
Bo = = (—Piw1 — Bowe — f3ws3) (3.102) 


2 
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After performing a similar derivation for the Ba, Bo and B3 terms, the four 
coupled kinematic differential equations for the Euler parameters are found to 
be the exceptionally elegant matrix form 


8o | 0 —w, —w2 —w3} (Go 
Pr ljw, 0 wz —we| | Ar 
: = 3.103 
(2 2 f —w3 0 wi} | Be ( ) 
3 Wz Wg wy, 0 ee) 


or by transmutation of Eq. (3.103), the kinematic differential equation has the 
elegant form 


Bo Bo Bi SS bar, 83)" 0 
Ai} _1]f Bo Bs Bo} Jw 
Bo}  2}B2 Bs Bo Bi} | we et02) 
B3 B3 —B2 Pr Bol \ws 


Note that the transformation matrix relating B and w is orthogonal and sin- 
gularity free. The inverse transformation from w to d(@)/dt is always defined. 
Further, the Euler parameter kinematic differential equation of Eq. (3.103) is 
rigorously linear if w,;(¢) are known functions of time only. If w;(t) are them- 
selves coordinates, then Eqs. (3.103) and (3.104) are more generally considered 
bi-linear. This makes the Euler parameters very attractive attitude coordinates 
for attitude estimation problems where the kinematic differential equation is lin- 
earized. All three parameter sets of attitude coordinates always have kinematic 
differential equations which are nonlinear and contain 0/0 type mathematical 
singularities. In attitude estimation problems their linearization is only locally 
valid. Whereas the linear (or bi-linear) property of the Euler parameter kine- 
matic differential equation is globally valid. The Euler parameter kinematic 
differential equation in Eq. (3.104) can be written compactly as 


b= s12O) (3.108) 


where the 4x3 matrix [B()] is defined as 


= Bi, =o >= Ps 
GIR ae (3.106) 
—B2 Pi Bo 


By carrying out the matrix algebra, the following useful identities can easily be 
verified. 


[B(3)|"B =0 (3.107) 
[B(8)|" 3’ = -[B(8‘)|"B (3.108) 
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It is easily verified that the normalization condition G7 = 1 is a rigorous 
analytical integral of Eqs. (3.103), (3.104). However, in practice the norm of 
8B may slightly differ form 1 when numerically integrating Eq. (3.103). It is 
therefore necessary to take care to reimpose this condition differentially after 
each numerical integration step, if the solution is to remain valid over long 
time intervals. However, in contrast to the re-normalization of [C(t)] to satisfy 
[C]" [C] = [J3x3] when solving Eq. (3.27), only one scalar condition needs to be 
considered when integrating ((t). 

In control applications, often the four Euler parameters are broken up into 
two groups. The parameter {3 is single out since it contains no information 
regarding the corresponding principal rotation axis of the orientation being rep- 
resented. In effect, if is a scalar measure of the three dimensional rigid body 
attitude measure whose value is +1 or -1 if the attitude is zero. The remaining 
three Euler parameters are grouped together into a three-dimensional vector as 


Ee= (81, G2, G3)" (3.109) 


If the attitude goes to zero, then so will this vector. From Euler parameter 
differential equation in Eq. (3.104), it is evident that the differential equations 
for 89 and € are of the form 


: 1 1 

Bo = —5e = —zwre (3.110) 
[Tw (3.111) 
The 3 x 3 matrix [T] is defined as 


[T (50, €)] = Bol[Isx3] + [é] (3.112) 


3.5 Classical Rodrigues Parameters 


The origin of the classical Rodrigues parameter vector q (or Gibbs vector) dates 
back over a hundred years to the French mathematician O. M. Rodrigues. This 
rigid body attitude coordinate set reduces the redundant Euler parameters to a 
minimal three parameter set through the transformation 


Bas Baa 8 (3.113) 


Bo 


The inverse transformation from classical Rodrigues parameters to Euler pa- 
rameters is given by 


———— (3.114a) 


6; = —.— Ss i=1,2,3 (3.114b) 
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Using the definitions in Eq. (3.90) the vector q is expressed directly in terms of 
the principal rotation elements as the elegant transformation 


® 
q = tan xe (3.115) 


From Egs. (3.113) and (3.115) it is evident that the classical Rodrigues param- 
eters go singular whenever ® — +180 degrees. Very large rotations can be 
described with these parameters without ever approaching a geometric singu- 
larity. For rotations with |®| < 90°, it is evident that q(t) locates points near 
the origin bounded by the unit sphere. Compare this +180° nonsingular range 
to the Euler angles where any orientation is never more than 90 degrees away 
from a singularity. 

The small angle behavior of the classical Rodrigues parameters is also more 
linear than compared to the small angle behavior of any Euler angle set. Lin- 
earizing Eq. (3.115) it is evident that 








o. 
q~zé (3.116) 


This means that classical Rodrigues parameters will linearize roughly to an 
“angle over 2” type quantity, whereas the Euler angles linearize as an angle 
type quantity well removed from singular points. 
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Figure 3.10: Stereographic Projection of Euler Parameters to Classical 
Rodrigues Parameters 


As discussed in Ref. 22, the classical Rodrigues parameters can be viewed 
as a special set of stereographic orientation parameters. Stereographic pro- 
jections are used to map a higher-dimensioned spherical surface onto a lower- 
dimensioned hyperplane. In this case, the surface of the four-dimensional Euler 
parameter unit constraint sphere in Eq. (3.91) is mapped (projected) onto a 
three-dimensional hyperplane though Eq. (3.113). Figure 3.10 illustrates how 


SECTION 3.5 CLASSICAL RODRIGUES PARAMETERS 93 


such a projection would yield the classical Rodrigues parameters. The projec- 
tion point is chosen to be the origin G = 0 and the hyperplane upon which all 
Euler parameter coordinates are projected is the tangent surface at G9 = 1. Note 
that on the constraint sphere surface G9 = 1 corresponds to a ® = 0 degrees, 
(Go = 0 corresponds to 6 = +180 degrees and Go = -1 represents 6 = +360 
degrees. The transformation in Eq. (3.113) maps any Euler parameter set on 
the unit constraint sphere surface onto a corresponding point located on the 
classical Rodrigues parameter hyperplane. 

All stereographic orientation parameters can be viewed as a projection of the 
constraint sphere onto some hyperplane. Since the Euler parameters themselves 
are not unique, the corresponding stereographic orientation parameters are also 
generally not unique. The set corresponding to the projection of the Euler 
parameter set —@ is referred to as the shadow set and is differentiated from the 
original set by a superscript $.2? However, it turns out that the shadow set of 
the classical Rodrigues parameters are indeed identical to the original classical 
Rodrigues parameters as is easily verified by reversing the G; signs in Eq. (3.113) 
or by inspection of Figure 3.10. 








5 _ oh 
Gq = =a = Gi 
The direction cosine matrix in terms of the classical Rodrigues parameters 


can be found by using their definition in Eq. (3.113) in the direction cosine 
matrix formulation in Eq. (3.92). The resulting parameterization is in matrix 


(3.117) 


form* 22 
1 l+qi-@—-@ 2(qi¢2+493) 2(qi93 — g2) 
[C| = Tara 2(a291—93) l-agi+aq3-—43 2(q293+%) (3.118) 
2(aqa+q) 22(a3¢—-u) 1l-gi-G+¢ 
and in vector form® ?2 
1 
C) = ——— ((1— q7Qq) [Isx3] +2qq? — 21g 3.119 
iC Sie Taq ((1 —q"q) [Isx3] +2qaq" — 2[q]) (3.119) 


The simplest way to extract the classical Rodrigues parameters from a given 
direction cosine matrix is to determine the Euler parameters first and then use 
Eq. (3.113) to find the corresponding Rodrigues parameters. Note the following 
useful identity. 


[C(@)|" = [C(-9)] (3.120) 


Since q defines the relative orientation of a second frame to a first frame, the 
relative orientation of the second frame relative to the first corresponds simply 
to reversing the sign of q as in 


{A} = [C(q)]"{b} = [C(—a@)|{b} (3.121) 


This elegant property doesn’t exist with Euler angles. 
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Similar to the direction cosine matrices and Euler parameters, the classical 
Rodrigues parameter vectors have a composite rotation property. Given two 
attitude vectors q’ and q”, let the overall composite attitude vector q be defined 
through the quadratically nonlinear condition 


[FN(q)] = [FB(a")[BN(q’)] (3.122) 


However, solving for an overall transformation from q’ and q” to q using 
Eq. (3.122) is very cumbersome. Using the successive rotation property of the 
Euler parameters and the definition of the classical Rodrigues parameters in 
Eq. (3.113), the composite attitude vector q is expressed directly in terms of gq’ 
and q” through” 78 


" '_ gy @! 
= first (3.123) 
Assume that the attitude vectors q and q’ are given and the relative attitude 
vector q” is to be found. With direction cosine matrices and Euler parameters 
the two attitude descriptions were related through an orthogonal matrix which 
made finding the relative attitude description trivial. This is no longer the case 
with the classical Rodrigues parameter composite rotation property. However, 
we can use Eq. (3.122) to solve for [F'B(q’’)] first using the orthogonality of the 
direction cosine matrices. 


[FB(q")] = [FN(@)\[BN(q‘)]* (3.124) 
Using the identity in Eq. (3.120), this is rewritten as 
[FB(q")] = [FN(q)|[BN(—q’)]| (3.125) 


which then leads to the desired direct transformation from q and q’ to the 
relative orientation vector q”. 
= zy! + x / 
ihe q-drqxq (3.126) 
I+q-q' 

A similar transformation could be found to express q’ in terms of q and q”. 

The kinematic differential equation of the classical Rodrigues parameters is 
found by taking the derivative of Eq. (3.113) and then substituting the corre- 
sponding expressions for 3; given in Eq. (3.104). The resulting matrix formula- 
tion is* 

l+q@ ae2-a nat] (ur 


qd== |lantoa 1464 wa-—m] [we (3.127) 
2 2 
Ba-d@ gata 144 W3 


and the compact vector matrix form is 
1 


q= 3 [Usx3] + [4] + aq7] (3.128) 
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Note that the above kinematic differential equation contains no trigonometric 

functions and only has a quadratic nonlinearity. It is defined for any rotation 

except for ® = +180 degrees. As g(t) approaches 6 = +180°, both q(t) and 

q(t) diverge to infinity. The inverse transformation of Eq. (3.128) is given by® 
_ 2 

“ T#9?@ 








([Zsx3] — [@]) 4 (3.129) 


As is evident, for (q,q) — ov, the transformation of Eq. (3.129) exhibits an 
oo/oo type singular behavior near |®| — +180 degrees. 

There exists a very elegant, analytically exact transformation between the 
orthogonal direction cosine matrix [C] and the classical Rodrigues parameter 
vector q called the Cayley Transform.* > 1° 1% 24 What is remarkable is that 
this transformation holds for proper orthogonal matrices of dimensions higher 
than three. A proper orthogonal matrix is an orthogonal matrix with a deter- 
minant of +1. Thus it is possible to parameterize any proper orthogonal [C] 
matrix by a minimal set of higher-dimensional classical Rodrigues parameters. 

The Cayley Transform parameterizes a proper orthogonal matrix [C] as a 
function of a skew-symmetric matrix [Q]: 


[C] = (17) - [@]) (+ (1) * = (1 + [@)* (1 - [@) (3.180) 


The matrix product order is irrelevant in this transformation. Another surpris- 
ing property of this transformation is that the inverse transformation from the 
skew-symmetric matrix Q back to the [C] matrix has exactly the same form as 
the forward transformation in Eq. (3.130): 


[2] = (4) - [e) (a) + (el) = (1 +(e) (4) - [e)) (3.181) 





For the case where [C] is a 3x3 rotation matrix, the transformation in Eq. (3.130) 
yields the standard three-dimensional Rodrigues parameters. This can be ver- 
ified by setting [Q] = [gq] in Eq. (3.130), carrying out the 3 x 3 special case 
algebra implicit in Eq. (3.130) and comparing the result to Eq. (3.118). The 
kinematic differential equation of the [C] is given in Eq. (3.27). This expres- 
sion also holds for matrix dimensions higher than three.* !° Since the Cayley 
Transform parameterizes a proper orthogonal matrix in terms of an “orientation 
coordinate” type quantity [Q], the matrix [@] represents an analogous “angular 
velocity” cross product matrix which can be defined as* 1% 17 


[2] = 2 (2) + [@])* [2] (1 - (a) (3.182) 


The kinematic differential equation of the higher dimensional Rodrigues param- 
eters is obtained by differentiation of Eq. (3.131), and substituting Eqs. (3.27) 
and (3.130) as 


[2] = 5 (U1 + [Q)) [2] (12) — [@)) (3.183) 


It can readily be verified that the 3 x 3 special case of Eq. (3.133) is equivalent 
to Eq. (3.127); so again the general n x n case contains the classical 3 x 3 results. 
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Example 3.8: Given the orthogonal 4x4 matrix [C], 


0.505111 —0.503201 —0.215658 0.667191 
0.563106 —0.034033 —0.538395 —0.626006 
0.560111 0.748062 0.272979 0.228387 
—0.337714 0.431315 —0.767532 0.332884 


[C] = 


it is easy to verify that [C] can be parameterized in terms of higher dimensional 
classical Rodrigues parameters. Using MATLAB to solve Eq. (3.131), the 
skew-symmetric 4x4 matrix [Q] is found to be 


0 0.5 0.2 0.3 
-05 0O O07 06 
ll=|_o29 -07 0 —0.4 
0.3 -06 04 O 


where the six upper diagonal elements of [Q] are the higher dimensional 
classical Rodrigues elements. 


3.6 Modified Rodrigues Parameters 


The Modified Rodrigues Parameters (MRPs) are an elegant recent addition to 
the family of attitude parameters.” 22 25-27 The MRP vector o is defined in 
terms of the Euler parameters as the transformation 





Bi 
i= 47=1,2,3 3.134 
1+ Bo ( ) 
The inverse transformation is given by 
1—o? 20; 
=, BS, og 3.135 
Bo 1+o? B eg?” ( ) 


where the notation 0?” = (o7 a)" is introduced. Substituting Eq. (3.90) into 
Eq. (3.134) the MRP can be expressed in terms of the principal rotation elements 
as 


® 
o =tan ze (3.136) 


Studying Eq. (3.136), it is evident that the MRP have a geometric singularity at 
= +360 degrees. Any rotation can be described except a complete revolution 
back to the original orientation. This gives o twice the rotational range of the 
classical Rodrigues parameters. Also note that for small rotations the MRPs 
linearize as o © (@/4) é. 
Observing Eq. (3.134) it is evident that these equations are well-behaved 
except near the singularity at G9 = —1, where ® — +360°. Also, the inverse 
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Figure 3.11: Stereographic Projection of Euler Parameters to Modified 
Rodrigues Parameters 


transformation of Eq. (3.135) is well-behaved everywhere except at |a| — 00; 
we see from Eq. (3.136) that this again occurs at ® > 360°. 

The MRP vector o can be transformed directly into the classical Rodrigues 
parameter vector q through 


oes (3.137) 
a 
with the inverse transformation being 
oe (3.138) 
1+/1+4q"q 
Naturally, these transformations are singular at @ = +180 degrees since the 





classical Rodrigues parameters are singular at this orientation. 

As are the classical Rodrigues parameters, the MRPs are also a particu- 
lar set of stereographic orientation parameters. Equation (3.134) describes 
a stereographic projection of the Euler parameter unit sphere onto the MRP 
hyperplane normal to the Go axis at 39 = 0, where the projection point is at 
8 = (-1,0,0,0). This is illustrated in Figure 3.11. As a +360 degree principal 
rotation is approached (i.e. 89 — —1), the projection of the corresponding point 
on the constraint sphere goes to infinity. This illustrates the singular behavior 
of the MRPs as they describe a complete revolution. 

However, contrary to the classical Rodrigues parameters, the projection of 
the alternate Euler parameter vector —G results in a distinct set of shadow (or 
“image” ) MRPs as can be seen in Figure 3.11. Each MRP vector is an equally 
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valid attitude description satisfying the same kinematic differential equation. 
Therefore one can arbitrarily switch between the two vectors through the map- 
+ 22, 26 
ping 
S — Bi O54 


O; 1 Bo a es 3 (3.139) 








where the choice as to which vector is the original and which the shadow vector 
is arbitrary. We usually let o denote the mapping point interior to the unit 
sphere and o* the point point exterior to the unit sphere. As with the non- 
uniqueness of the principal rotation vector y and the Euler parameter vector 
B, one set of MRPs always corresponds to a principal rotation ® < 180 degrees 
and the other to ® > 180 degrees. From Eq. (3.136) it is clear that 


lol <1 if ®<180° 
lol >1 if ®&>180° (3.140) 
lol =1 if &®=180° 


The behavior is seen in Figure 3.11. The unit sphere |o| = 1, corresponding 
to all principal rotations of 180° from the origin, is of particular importance. 
As one set of MRPs exits the unit sphere, the other (shadow) set enters. The 
mapping in Eq. (3.139) can be written in terms of the principal rotation elements 
using the definitions of 6; in Eq. (3.90) as 


b-2 
o* = tan ( 7 *) é (3.141) 


Using Eq. (3.74) this can be written directly in terms of the alternate principal 
rotation angle ©’. 





’ 
o* =tan (=) é (3.142) 


Eq. (3.142) clearly shows that the shadow MRP vector is a direct result of the 
alternate principal rotation vector. 

The shadow MRPs have a singular orientation at ® = 0 degrees as compared 
to the original MRPs, which are singular at 6 = +360 degrees. This allows 
one to avoid MRP singularities all together by switching between original and 
shadow MRP sets as one MRP vector approaches a singular orientation. On 
which surface a7 ao = c one switches is arbitrary. However, switching between 
the two MRPs whenever the vector o penetrates the surface a7 a = 1 has many 
positive aspects. For one, the map between the two MRP vectors simplifies on 
this surface to 0% = —o. Further, the magnitude of o will remain bounded 
above by 1. Having a bounded norm of an attitude description is useful since 
it reflects the fundamental fact that two orientations can only differ by a finite 
rotation. Also, the current MRP attitude description will always describe the 
shortest principal rotation because of Eq. (3.140). Therefore the combined set 
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of original and shadow MRPs with the switching surface oa = 1 provides for 


a nonsingular, bounded, minimal attitude description. It is ideally suited to 
describe large, arbitrary motions. The combined set is also useful in a feedback 
control type setting. For example, it linearizes well for small angles and has 
a bounded maximum norm of 1 which makes the selection of feedback gains 
easier. 

The direction cosine matrix in terms of the MRP is found by substituting 
Eq. (3.135) into Eq. (3.92) and is given as® 22; 26; 27 


4 (of —03-03) + (1-07)? 80102 + 403(1 — 07) 
[Cl = are 80201 — 403(1 — 0”) 4 (—o7+03—0%) + (1 — 0°)? 
80301 + 409(1 — 07) 80302 — 40, (1 — 0?) 


80103 = 4oo(1 = a”) 
80203 +4o,(1 = a”) 
4 (—of —0$+03) + (1-07)? 


(3.143) 
In compact vector form [C] is parameterized in terms of the MRP as® ?? 
8[a]? — 4 (1 — 07) fe 
[C] = [Usxs] + Hel SS0Se) a (3.144) 


(1 +02)" 


As is the case with the classical Rodrigues parameters, the simplest method to 
extract the MRP from a given direction cosine matrix is the first extract the 
Euler parameters and then use Eq. (3.134) to find the MRP vector a. If G9 > 0 
is chosen when extracting the Euler parameters, then |o| < 1. If fo is chosen to 
be negative, then the alternate MRP vector corresponding to a larger principal 
rotation angle is found. 

The MRPs enjoy the same relative rotation identity as did the classical 
Rodrigues parameters. 


(Clo)? = [c(-2)) (3.145) 


Given two MRP vectors o’ and o”, let the overall MRP vector o be defined 
through 


[FN(o)] = [FB(o")||BN(o’)] (3.146) 


Starting with the Euler parameter successive rotation property and using the 
MRP definitions in Eq. (3.134), the MRP successive rotation property is ex- 
pressed as° 
1—|oe'|2)o" + (1 — |e" |2)o' — 20” x a’ 
| O-le'P)o" + 1 Jo") re 
1 + |o'|2|a""|? = 20° s o” 
Using Eq. (3.145), we are able to express the relative attitude vector 0” in terms 
of o and o’ as 
(1 —|o’|?)o — (1 — |o|?)o’ + 20 x o’ 


0 we 3.148 
% 1+ |o’|?|o|/? + 20’-o ( ) 
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While these expressions are more complicated than their Euler parameter or 
classical Rodrigues parameter counterparts, they do provide a numerically ef- 
ficient method to compute the composition of two MRP vectors or find the 
relative MRP attitude vector. 


Example 3.9: Given the Euler parameter vector 3 
3 = (0.961798, —0.14565, 0.202665, 0.112505)” 


the MRP vector o is found using Eq. (3.134) 





—0.14565 
aan GRITOR © —0.0742431 
02 = er = 0.103306 
0.112505 
O85 3 p.0RT TOR 0.0573479 
The alternate shadow MRP vector o° can be found using —@ instead of B 
in Eq. (3.134). 
of = —aaaae = 3.81263 
ee a = —5.30509 
o3 = ee = —2.945 


Note that if the direct mapping in Eq. (3.139) is used the same vector o* 


is obtained. Since the vector |o| = 0.139546 < 1, it represents the shorter 
principal rotation angle of ® = 7.94 degrees. The vector |o*| = 7.16611 > 1 
represents the longer principal rotation angle ®’ = 6 — 360° = —328.224°. 


The kinematic differential equation of the MRPs is found in a similar man- 
ner as the one for the classical Rodrigues parameters. The resulting matrix 
formulation is??> 27 


1-07 +20? 2(0,02-—03) 2(0103+02)] [wr 
o=- 2 (0201 + 03) 1-07 +203 2 (0203 — 01) W9 (3.149) 
2(030, —02) 2(0302+01) 1—07 +203 W3 


The MRP kinematic differential equation in vector form is” ?? 
st 2 ss ac 1 
=F [(1 — 07) [3x3] + 2[6] +2007] w= 7 Blo) |w (3.150) 


Note that the MRPs retain a kinematic differential equation very similar to the 
classical Rodrigues parameters with only quadratic nonlinearity present. This 
equation holds for either set of MRPs. However, the resulting vector 6 will 
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depend on which set of MRPs is being used. Just as a mapping exists between 
o and o°, a direct mapping between & and o°® is given by?® 


> 1/140 
65 = a +5 (=) oot w (3.151) 


Let the matrix [B] transform w in Eqs. (3.149) and (3.150) into 6. Turns 


out that this [B] matrix is almost orthogonal except for a generally non-unit 
scaling factor. The inverse of [B] can be written as 


1 

B\-' = ——.,[B]" 3.152 
BI = 7B (3.152) 
To prove Eq. (3.152) let’s study the expression [B]7[B]. Using Eq. (3.150) this 
is written as 


[B]" [B] = ((1 — 07) [I3x3] — 2[6] + 2007) ((1 — 0”) [I3x3] + 2[6] + 2007) 


After carrying out all the matrix multiplications the [B]?[B] expression is re- 
duced to 


[B]7 [B] = (1 - 0”)? [3x3] — 4[]? + 4007 


Z 


which can be further simplified using the identity [6]? = aa? — 07[I3x3] to 


[B]7 [B] = (1+ 07)? [Igx3] 


At this point it is trivial to verify that Eq. (3.152) must hold. The inverse 
transformation of Eqs. (3.149) and (3.150) then is in matrix notation 


4 
w = ——_, [B]"e 


ae (3.153) 


and in vector form® 


= ae [(1- 0?) lIsxs] 21] +2007] 6 (3.154) 


Like the classical Rodrigues parameters, the MRPs can also be used to min- 
imally parameterize higher-dimensional proper orthogonal matrix [C]. Let the 
[S] be a skew-symmetric matrix. The extended Cayley transform of [C] in terms 
of [S] ist” 79 


[C] = ({Usx3] — [S])? (1 + [S])~? = (1 + [S])~? (sx - [S])? (3.155) 


where the order of the matrix products is again irrelevant. For the case where 
[C] is a 3x3 matrix, then [5] is the same as [@]. Therefore Eq. (3.155) transforms 
a higher dimensional proper orthogonal [C] into higher dimensional MRPs. 
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Unfortunately no direct inverse transformation exists like Eq. (3.131) for 
the higher order Cayley transforms.!” The transformation is achieved indirectly 
through the matrix [W], where it is defined as the matrix square root of [C]. 


[C] = [W]|W] (3.156) 


[C] = [V][DI[V]" (3.157) 


where [V] is the orthogonal eigenvector matrix and [D] is the diagonal eigenvalue 
matrix with entries of unit magnitude. The “*” operator stands for the adjoint 
operator which performs the complex conjugate transpose of a matrix. The 
matrix [W] can be computed as 


[W] =[V] | [D]ii [Vv] (3.158) 


The eigenvalues of [C] are typically complex conjugate pairs. If the dimension 
of [C] is odd, then the extra eigenvalue is real. For proper orthogonal matrices 
it is +1 and its square root is also chosen to be +1. The resulting [W] matrix 
will then itself also be an proper orthogonal matrix. As Ref. 17 shows, the geo- 
metric interpretation of [W] is that it represents the same “higher-dimensional” 
orientation as [C] except that the corresponding principal rotation angles are 
halved. 

The standard Cayley transforms in Eqs. (3.130) and (3.131) can be applied 
to map [W] into [S] and back. 


[W] = (10) — [5] (7) + [5])~* = (Hz) + [S])“*() - ES) (3.159) 
[S] = (1) — (W)) (Lz) + [W])~* = (i) + [W))* (i) - [) (3.160) 


Therefore, to obtain a higher-dimensional MRP representation of [C], the ma- 
trix [W] must be found first and then substituted into Eq. (3.160). Note that 
substituting Eq. (3.159) into Eq. (3.156) a direct forward transformation from 
[S] to [C] is found. 


[C] = (7) - [$])? Cz] + [S])-? = (i) + £81) (i — ES)? (3.161) 


The kinematic differential equations for [5] are not written directly in terms 
of [C] as they were for the classical Cayley transform. Instead the [W] matrix 
is used. Being an orthogonal matrix, its kinematic differential equation is of the 
same form as Eq. (3.27) 


[W] = -[Q\[W] (3.162) 
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where [Q] is the corresponding angular velocity matrix. It is related to the [] 
matrix in Eq. (3.27) through 


[2] = [0] + [(W][Q][W)}* (3.163) 
Analogously to Eq. (3.133), the kinematic differential equation of the [S|] matrix 


is given by 


(LJ + [S]) [2] (Z] — [S]) (3.164) 


Example 3.10: Consider the same orthogonal 4x4 matrix [C] as is defined 
in Example 3.8. Using MATLAB, its matrix square root [W] is found to be 


0.86416 —0.35312 —0.14580 0.32754 
0.37209 0.69343 —0.44177 —0.43076 
0.25488 0.50816 0.79065 0.22734 
—0.22320 0.36911 —0.39807 0.80962 


[W] = 


Using Eq. (3.160) the higher dimensional, skew-symmetric MRP matrix [S] 
representing [C] is found. 


0 0.20952. 0.10114 —0.14383 

roc —0.20952 0 0.28309 0.24040 

—0.10114 —0.28309 0 —0.17471 
0.14383 —0.24040 0.17471 0 


By back substitution of this [S] into Eq. (3.155) it can be verified that it does 
indeed parameterize [C). 


3.7 Other Attitude Parameters 


There exists a multitude of other attitude parameters sets in addition to those 
discussed so far. This section will briefly outline a selected few. 


3.7.1 Stereographic Orientation Parameters 


The Stereographic Orientation Parameters (SOPs) are introduced in Ref. 22. 
They are formed by projecting the Euler parameter constraint surface, a four- 
dimensional unit hypersphere, onto a three-dimensional hyperplane. The pro- 
jection point can be anywhere on or within the constraint hypersphere, while 
the mapping hyperplane is chosen to be a unit distance away from the projection 
point. 

There are two types of SOPs, the symmetric and asymmetric sets. The 
symmetric sets have a mapping hyperplane that is perpendicular to the (o axis. 
Since G9 = cos ®/2 only contains information about the principal rotation angle, 
the resulting sets will all have a geometric singularity at a specific principal 
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rotation angle ® only, regardless of the corresponding principal rotation axis 
é. The classical and modified Rodrigues parameters are examples of symmetric 
SOPs. 

Asymmetric SOPs have a mapping hyperplane which is not perpendicular 
to the §o axis. The condition for a geometric singularity will now depend on 
both the principal rotation axis é and the angle ®. As an example, consider the 
asymmetric SOP vector 7. It is formed by having a projection point at G1 = —1 
and having a mapping hyperplane at 3, = 0. In terms of the Euler parameters 
it is defined as 























Bo Be G3 
= = = 3.165 
™ Cee 2 1s Bi 13 Tea ( ) 
with the inverse transformation being 
2n1 1-71? 2n2 273 
= = = = 3.166 
bape =i B= Bape (3.166) 


where 7? = nn. From Eq. (3.165) it is evident that 7 has a geometric singular- 
ity whenever 3; — —1. This means that 7 goes singular whenever it represents 
a pure single-axis rotation about the first body axis by the principal angles ®, 
= -180 degrees or ®2 = +540 degrees. This type of asymmetric principal angle 
rotation range is typical for all asymmetric SOPs. However, since the 7 vector 
has a distinct shadow counter part, any geometric singularities can be avoided 
by switching between the two sets through the mapping 


ni=-t (3.167) 
1 
The direction cosine matrix is written in terms of the 7 vector components 
as 


4 (ni—n3—n3) + (1-19?) 87193 + 4n2(1 — 7?) 
[C] = aap? —871N3 + 4n2(1 — 7) 4 (n?-+ng—n3) — (1 — 0”)? 
8nin2 + 4n3(1 — 7?) 8n2n3s — 4 (1 — 7?) 
—871N2 + 43(1 — 7) 
823 + 4m (1 — 9?) 
4 (nf—ngt+n3) — (1-1)? 





(3.168) 


The kinematic differential equation of the 7 vector is 


—1-2nf+7° 2(mn3—n2) -—2(mn2 +73) 
7=—| 2(n3—mm2) 2(nen3+m) —-1—2ng+7?| w (3.169) 
—2(mng3+n2) 1+2n3—1? 2(m — nen) 


Having a projection point on the constraint surface provides for the largest 
possible range of singularity free rotations. This is evident when comparing 
the classical and the modified Rodrigues parameters. The classical Rodrigues 
parameters have a projection point within the constraint hypersphere at Go = 0. 
Their principal rotation range is half of that of the MRPs whose projection is 
on the constraint surface at G9 = —1. 
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3.7.2 Higher Order Rodrigues Parameters 


The Higher Order Rodrigues Parameters (HORP) are introduced in Ref. 29. The 
classical Cayley transform in Eq. (3.130) is expanded such that it parameterized 
nxn orthogonal matrices through a skew-symmetric, higher order Rodrigues 
parameter matrix X. 


[C] = ([Isx3] — X) ([Iax3] + X)~™ (3.170) 


The corresponding attitude vector a is given by 


ON 5 
x =tan (=) é (3.171) 
2m 


For m = 1 the vector x is the classical Rodrigues vector and for m = 2 it is 
the MRP vector. Note that the domain of validity of the a vector is |®| < ma. 
The HORP sets are generally also not unique as is the case with the MRPs. 
Corresponding “shadow” sets can be used here too to avoid any geometric sin- 
gularities. Note that for a given m there are typically m sets of possible HORPs. 

A particular set of HORP is the 7 vector where m = 4. In terms of the 
Euler parameters, the first two HORP vectors 7 are defined through 


Bi 








= _ 1 1,2,8 (3.172) 
1+ Bo + /2 (1+ Go) 
with the inverse transformation being 
1—72\? 47; (1 — 77) 
= 12, -1 £= ————>~ 1=1,2,3 3.173 
- (2) eae wae 


where 7?” = (ery Each vector 7 defined in Eq. (3.172) can be mapped to 
the corresponding shadow vector 7° through 


Opie (3.174) 
ae 277+ (14+7?)7 : 


where 7 = V7?. Combined Egs. (3.172) and (3.174) yield the four possible 
HORP vectors for m = 4. In terms of the principal rotation elements, the four 
sets can be expressed as 


o-2 
7 = tan (7—**) k=0,1,2,3 (3.175) 


Therefore it will always be possible to switch from one 7 vector to another in 
order to avoid geometric singularities. 
The kinematic differential equations of the 7 vector are 
1 


oa Gey [2 (3-7?) rr? 4.4 (1-77) [#] + (1-67? 4+74)[Igx3]] w (3.176) 
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Note that the kinematic differential equations of the HORP lose the simple 
second order polynomial form that is present for the classical and modified 
Rodrigues parameters. Also, while the 7 vector itself is defined for rotations 
up to ® = mz, the kinematic differential equations encounter mathematical 
singularities of the type 0/0 whenever tT? — 0. This corresponds to ® > 
+360 degrees. By using the mapping in Eq. (3.174) to transform a 7 vector to 
an alternate set whenever |r| > tan(®/8) any geometrical and mathematical 
singularities are avoided all together. 





3.7.3. The (w, z) Coordinates 


The (w,z) attitude coordinates were introduced by Tsiotras and Longuski in 
Ref. 30. They are a minimal coordinate set and lend themselves well to be used 
in control problems of under actuated axially-symmetric spacecraft.?4 The com- 
plex coordinate w describes the heading of the one of the body axes, typically 
the spin axis. The coordinate z is the relative rotation angle about this axis 
defined by we Let the heading of the chosen body axis be given by the vector 
b; = (a,b ,c). Since the vector 6; is a unit vector, the three components a,b 
and c are not independent. They must satisfy the constraint sphere equation 


a+ePt+e=l (3.177) 


By performing a stereographic projection of the constraint sphere from the 
projection point (0,0, —1 onto the complex (w1, w2) plane, the three redundant 
axis heading coordinates (a,b,c) are reduced to the complex variable w. 





b— ia 
= iw = 3.178 
wW= W1 + we aise ( ) 
The inverse transformation from w to (a,b,c) is given by 
i(w — @) w+w 1 — |w/|? 
= + 1 §= —— C= — ~ 3.179 
TTP T+fwe ©” T+ ]wP ved 


Let’s assume that the spin axis is the third body axis, then the direction cosine 
matrix in terms of (w, z) is given by 


Re[(1+w’)e*]  Im|(1+w?)e*] —2Im(w) 


Im|(1—w*)e"*]  Re[(1—w*)e"**] — 2Re(w) (3.180) 
2Im(we'”) —2Re(we'”) 1 — |w|? 


1 


I= Ty hoP 


The kinematic differential equations of the (w, z) coordinates are given by 


Wy = w3W2 + wow we + > (1 +? — w3) (3.181a) 
W2 = —W3W, + Wy WywWe + = (1 + we — wr?) (3.181b) 


a W3 — W{W2W2W1 (3.181c) 
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3.7.4 Cayley-Klein Parameters 


The Cayley-Klein parameters are a set of four complex parameters which are 
closely related to the Euler parameter vector G. They form a once-redundant, 
non-singular set of attitude parameters. Let i = /—I, then they are defined in 
terms of @ as!® 


a= Bo + 183 B=—Bo+ify 
y= Bo t+iph b = Bo — is te) 





The inverse transformation from the Euler parameters to the Cayley-Klein pa- 
rameters is 


B = (a+) /2 By, =-i(B+~7) /2 
b= -(6-y7)/2  83= -i(a-64)/2 (3.183) 


The direction cosine matrix is parameterized by the Cayley-Klein parameters 
as 


(°- #48) /2 i(-a?+6?—7°+67) /2 (86-4) 
[C] = }i (a? +6?-7-67) /2 (a? +6? +77+67) /2  -i (ary + 86) (3.184) 
(76 — a8) i (a +6) (ad + By) 


3.8 Homogeneous Transformations 


All previous sections in this chapter deal with methods to describe the relative 
orientation of one coordinate frame to another. In particular, the direction 
cosine matrix is a convenient tool to map a vector with components taken in 
one reference frame to a vector with components taken in another. However, 
one underlying assumption here is that both reference frames have the same 
origin. In other words, any translational differences between the two frames in 
questions is not taken into account when the vector components are mapped 
from one frame to another. 

Figure 3.12 shows an illustration where two coordinates frames differ both in 
orientation and in their origins. Let us define the following two reference fame 


N and B. 


N: {On, 11, 2, N3} 
B : {Og, by, b2, bs} 


Let the position vector from the N frame origin to the B frame origin be given 
by rg; The position vector of point P is expressed in B frame components 
as B Tr». These vector components are mapped into NV frame components by 
pre-multiplying by the direction cosine matrix [NB]. While this provides the 
correct NV frame components of the vector rp, it does not provide the correct 
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Body Frame / | 


n, 


Inertial Frame 


Figure 3.12: Illustration of two Coordinate Frames with Different Ori- 
gins and Orientations 


position vector of point P as seen by the NV frame since the two frames have 
different origins. To obtain these vector components, we compute 


Nr = rgiy + [NBI]Pry (3.185) 


By defining the 4 x 4 homogeneous transformation?” 


Np 
WB] = he a (3.186) 


it is possible to transform the position vector taken in 6B frame components 
directly into the corresponding position vector in NV frame components. In 
robotics literature, this transformation is typically referred to as _ T. To ac- 
complish this, we define the 4 x 1 position vector 


By 
Bo = | | (3.187) 
Observing Eq. (3.185), it is clear that 


\'p = (NB)? p (3.188) 


This formula is very convenient when computing the position coordinate of a 
chain of bodies such as are typically found in robotics applications. However, 
care must be taken when considering the order of the translational and rotational 
differences between the two frames. The homogenous transformation, as shown 
in Eq. (3.186), performs the translation first and the rotation second. This order 
is important. Assume a rotational joint has a telescoping member attached to it. 
To compute the homogeneous transformation from the joint to the telescoping 
member tip, a rotation must be performed first and a translation second. 
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Note that this homogenous transformation matrix abides by the same suc- 
cessive transformation property as the direction cosine matrix does. Consider 
the two vectors 


“p = [AB]"p (3.189) 
Np = |NA|4p (3.190) 
Substituting Eq. (3.189) into (3.190), we find that 

“'p = (NAILAB)?p = WB)? p (3.191) 

Thus, two successive transformations are combined through 
VB] = (NV AI[AB] (3.192) 
However, the inverse matrix formula for the homogeneous transformation is not 
quite as elegant as the matrix inverse of the orthogonal direction cosine matrix. 


The following partitioned matrix inverse is convenient to compute the inverse 
of the [VB]. Let [M] be defined as* 





[M] = E 3 (3.193) 
Then the inverse is given by 
[M]-t = li : Wee ar oe pas | (3.194) 
with the Schur complement being defined as 
A=D—CA'B (3.195) 
Substituting 
[A] = [NB] [B] = ry] 
[C] = [01x3] [D] = [1] 
the Schur complement is given by 
A = [1] (3.196) 


and the inverse of the homogeneous transformation is the remarkable simply 
formula: 


VB] = 


[NB]? —[N a Nr B/N (3.197) 


013 


Here the fact was used that [NB] is orthogonal and that [NB]~! = [NB]’. 
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Problems 


3.1 Given three reference frames NV’, B and F, let the unit base vectors of the 
reference frames B and F be 


1 0 4 


bres Os). beet) Bee |S 
EE NS So Bah fA Bias 


— 
> 

KH 
> 

BR 


and 


fae i aM Se we. eT v3 
da 5 ~2 jos 0 I 2/3 
V3 V3. 1 


where the base vector components are written in the V frame. Find the direction 
cosine matrices [BF] that describes the orientation of the B frame relative to 
the F frame, along with the direction cosine matrices [BN] and [FN] that map 
vectors in the VV frame into respective B or F frame vectors. 


3.2 


Let the vector v be written in B frame components as 
B x. nN x 
v = 1b; + 2b2 — 3b3 


The orientation of the B frame relative to the VV frame is given through the 
direction cosine matrix 


—0.87097 0.45161 0.19355 
[BN] = |—0.19355 —0.67742 0.70968 
0.45161 0.58065 0.67742 


a) Find the direction cosine matrix [NB] that maps vectors with components 
in the B frame into a vector with NV’ frame components. 


b) Find the VV frame components of the vector v. 


3.3 Using the direction cosine matrix [BN] in Problem 3.2, find its real eigenvalue 
and corresponding eigenvector. 


3.4  @& The angular velocity vectors of a spacecraft B and a reference frame motion R 
relative to the inertial frame WV are given by wg/y and wey. The vector wry 
is given in ® frame components, while wy /,- is given in B frame components. 
The error angular velocity vector of the spacecraft relative to the reference motion 
is then given by dw = wg/y—Wryy. Find the relative error angular acceleration 
vector dw with components expressed in the 6 frame. 


a) Find dw by only assigning vector frames at the last step. 


b) Find dw by first expressing dw in B frame components as Bw = Bw in — 


[BR]°wriw and then performing an inertial derivative. 
3.5 The reference frames NV : {f1, 72,73} and B: {br, bo, b} are shown in Fig- 
ure 3.13. 
a) Find the direction cosine matrix [BN] in terms of the angle ¢. 


b) Given the vector y= 16, + 1be + 261, find the vector “v. 
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3.6 


3.7 


3.8 


3.9 


3.10 


3.11 


3.12 


3.13 





Figure 3.13: Disk Rolling on Circular Ring 


Starting with Eqs. (3.21) and (3.22), verify Eq. (3.24). 


Parameterize the direction cosine matrix [C] in terms of (2-3-2) Euler angles. 
Also, find appropriate inverse transformations from [C] back to the (2-3-2) Euler 
angles. 


Find the kinematic differential equations of the (2-3-2) Euler angles. What is 
the geometric condition for which these equations will encounter a mathematical 
singularity. 


Given the (3-2-1) Euler angles % = 10°, 6 = —15° and ¢ = 20° and their rates 
wb = 2°/s, 9 =1°/s and ¢ = 0°/s, find the vectors %w and “w. 
The orientation of an object is given in terms of the (3-1-3) Euler angles 
(—30°, 40°, 20°), 

a) find the corresponding principal rotation axis é 

b) find the two principal rotation angles ® and &’ 
A spacecraft performs a 45° single axis rotation about é = = (1,1, se Find 


the corresponding (3-2-1) yaw, pitch and roll angles that relate the final attitude 
to the original attitude. 


Verify that the exponential matrix mapping [C] = e*l4] does have the finite 
form given in Eq. (3.81). 


Verify that Eq. (3.89) is indeed the inverse mapping of the differential kinematic 
equation of + given in Eq. (3.88). 


3.14 d& Starting from the direction cosine matrix [C] in Eq. (3.71) written in terms of 


the principal rotation elements, derive the parameterization of [C] in terms of 
the Euler parameters. 


3.15 d& Derive the composite rotation property of the Euler parameter vector given in 


3.16 


Eqs. (3.97) and (3.98). 


Derive the kinematic differential equations for the second, third and fourth Euler 
parameter. 
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3.17 Verify the transformation in Eq. (3.114) which maps a classical Rodrigues pa- 
rameter vector into an Euler parameter vector. 


3.18 Show the details of transforming the classical Rodrigues parameter definition in 
terms of the Euler parameters gi = 3;/(Go into the expression q; = tan sé; which 
is in terms of the principal rotation elements. 


3.19 d& Show that the classical Rodrigues parameters are indeed a stereographic pro- 
jection of the Euler parameter constraint surface (a four-dimensional unit hy- 
persphere) onto the three-dimensional hyperplane tangent to Go = 1 with the 
projection point being G = (0,0,0,0)7. 


3.20 — Given the classical Rodrigues parameter vector g = (0.5, —0.2,0.8)7. Use the 
Cayley transform in Eq. (3.130) to find the corresponding direction cosine matrix 
[C]. Also, verify that this [C] is the same as is obtained through the mapping in 
Eq. (3.118) or (3.119). 


3.21 Verify the transformation in Eq. (3.135) which maps a MRP vector into an Euler 
parameter vector. 


3.22 Show the details of transforming the MRP definition in terms of the Euler pa- 
rameters 0; = (i: /(1+ Go) into the expression oj = tan 2é; which is in terms of 
the principal rotation elements. 


3.23 de Show that the MRPs are a stereographic projection of the Euler parameter con- 
straint surface (a four-dimensional unit hypersphere) onto the three-dimensional 
hyperplane tangent to 39 = 0 with the projection point being B = (—1, 0,0, 0)7. 


3.24 Derive the MRP parameterization of the direction cosine matrix [C] given in 
Eq. (3.143). 


3.25 Let the initial attitude vector be given through the MRP vector o(to) = 
(0,0,0)7. The body angular velocity vector w(t) is given as (1,0.5,—0.7)7 
rad/second. Integrate the resulting rotation for 5 seconds and use the mapping 
between “original” and “shadow” MRPs in Eq. (3.139) to enforce |o| < 1. 


3.26 @& Derive the mapping between & and its shadow counter part &* in Eq. (3.151) 
starting with the kinematic differential equation of the MRP in Eq. (3.150) and 
Eq. (3.139). 


3.27 — Given the MRP vector o = (—0.25, —0.4,0.3)7. Use the Cayley transform in 
Eq. (3.161) to find the corresponding direction cosine matrix [C]. Also, verify 
that this [C] is the same as is obtained through the mapping in Eq. (3.143) or 
(3.144). 
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CHAPTER FOUR 


Eulerian Mechanics 





The dynamics of a continuous body, as presented in the chapter Newtonian 
Mechanics, is specialized in this chapter for the case of rigid body dynamics. 
This means that all continuous bodies studied will have a constant shape. This 
is the most common case for many applications. Systems such as satellites, 
aircraft or robots are all typically modeled as sets of rigid bodies. The rotational 
dynamics of a rigid body are often referred to as Eulerian Mechanics, since 
Euler’s equation H = L and Euler’s rotational equation of motion generally 
govern this field. 

Unlike the chapter Newtonian Mechanics, this chapter will first investigate 
the rigid body angular momentum vector H and its derivative, along with the 
kinetic energy before developing the rotational equations of motion. Then the 
rigid body dynamics in a torque free environment will be studied in more detail. 
Further, the dynamics of a rigid body is studied when a set of variable speed 
control moment gyroscopes are present or the body is under the influence of 
gravity gradient torques. 


4.1 Rigid Body Dynamics 


4.1.1. Angular Momentum 


The following development will parallel the development in Section 2.4 for the 
case where no body deformations were allowed. Let the moment be taken either 
about the center of mass or the inertial coordinate frame origin. In either case 
Euler’s equation reduces to 


H=L (4.1) 
Let R be the inertial position vector of an infinitesimal mass element dm. Let’s 


choose the moment to be defined about the coordinate frame origin O. It turns 
out this case will include the case of having the moment defined about the center 
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of mass R,. The angular momentum vector in Eq. (2.95) is reduced to 
Ho = 7 Rx Rdm (4.2) 
Since R= R,.+,7 this is rewritten as 
Ho= I (R. +1) x (R. + *) dm (4.3) 
which is then expanded to 


Ho= | Rex Reim+ | rimx Rot Rex | 
B B 


tam [ rxrdm (4.4) 
B B 


Noting that the mass of the rigid body is constant and using the definition 
of the center of mass in Eq. (2.77), the angular momentum vector about the 
coordinate frame origin O is reduced to the expression 


Ho = R. x MR. +f rx rdm (4.5) 
B 


Eq. (4.5) is written for the general case where the rigid body B is rotating about 
its center of mass and the center of mass is moving independently at an inertial 
velocity R, as shown in Figure 4.1. 





Rigid Body B 





Figure 4.1: General Rigid Body Rotation 


The first term of Ho is the angular momentum of the mass center about the 
origin and its behavior was studied when discussing the dynamics of a single 
particle. The second term is more interesting since it contains the angular 
momentum vector H, of the rigid body 6 about its mass center R,. From here 
on we will be discussing mainly H, and not the more general Ho. 


H, = | rx ¢dm (4.6) 
B 
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At this point we will make use of some of the kinematics results from the previous 
chapter. By definition, the vector 7 is defined to be an inertial derivative, 
therefore 
sd Bq 
ge 
where the vector w is the instantaneous angular velocity vector of the rigid body 


B relative to the inertial frame VV. Since B is a rigid body the term "d/dt (r) is 
zero. Thus rf reduces to 


(r)+wxr (4.7) 


r=wxr (4.8) 


The angular momentum vector about the center of mass is then defined as 


A, = ie x (wx r)dm = ( / -trilriam) w (4.9) 


Let the vectors 6; be the B frame unit direction vectors, then the vector r, w 
and H, are written in B frame coordinates as 





r= r1b, + reb2 + r3b3 (4.10) 
w= ww by F wabs + w3b3 (4.11) 
H, = Hz,b1 + He,b2 + He,b3 (4.12) 


After carrying out the triple cross product and collecting all terms, the angular 
momentum vector H;, is expressed as 


B B B 
Ae, ts + re —11Pr2 —1r113 Wy 
H.= | He] = | —ryrg retr}  —rers w2 | dm (4.13) 
Ale, B —rirgs  —rerg or? +73 W3 


The entries in the 3x3 matrix are the moments and products of inertia of the 
rigid body 6 about its center of mass. Note that since the r vector components 
were taken in the 6 frame, the corresponding matrix components are also taken 
in the B frame. If a different coordinate system were assigned to the rigid body, 
the corresponding inertia matrix would be different too. Let this symmetric 
inertia matrix be called [J] where the subscript letter c indicates about which 
point the moments and products of inertia were taken. If this letter is omitted, 
then it is understood that this inertia matrix is defined about the center of mass. 

B 


r3 + re —T172. T1763 
AT, = ih —[r][F]dm =| TiN re +r3 —ror3 | dm (4.14) 
B B —1T1T3 —1T273 re + r2 


Since w does not vary over the volume it can be taken outside the integral. 
Unless noted otherwise, from here on it will be assumed that the vectors and 
inertia matrices are written in the B frame and the superscript letter 6 will be 
dropped. The angular momentum vector of a rigid body about its center of 
mass can then be written in its simplest form as! 
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4.1.2 Inertia Matrix Properties 





Figure 4.2: Rigid Body Rotation about Origin 


Developing Eq. (4.15) it was assumed that the rigid body B was free to 
rotate in space. Now it is assumed that the rigid body is no longer rotating 
independently from the center of mass motion, but instead it is orbiting a fixed 
point O such that it always keeps the same side facing this point as shown in 
Figure 4.2. Examples of this type of rotation would be the moon orbiting Earth 
or a rigid body swinging back and forth at the end of a suspended rope. The 
center of mass position vector R, with this type of rotation is fixed in the B 
frame and therefore has the following inertial derivative. 


fe = 2 (R) tux Raw x Re (4.16) 


Substituting Eq. (4.16) into Eq. (4.5) and making use of Eq. (4.15), the angular 
momentum vector about the origin O is written as 


Hj) =MR.xwx R.+ [I,|w (4.17) 


After making use of the skew-symmetric tilde operator defined in Eq. (3.23), 
the vector Ho is written as 


Ho = ( [Te] — MUR] [Fee]) w (4.18) 


This leads to the famous parallel axis theorem. Given the moment of inertia 
matrix [I,] of a rigid body B about its center of mass and the position vector 
R, of this center of mass relative some some fixed point O, then the inertia 
matrix of B about P is given through the transformation 


[To] = [Ie] + M[R.][R.]7 (4.19) 
Note that the fixed point O does not have to be the origin, but it can be 
any inertially fixed location. Also, note that when expressing [J,] and R, in 
component form, for the matrix subtraction in Eq. (4.19) to be meaningful, 
both [Z,] and R, must be expressed in the same coordinate frame. The resulting 
matrix [Jo] will also have components taken in the same frame. 


SECTION 4.1 RIGID BODY DYNAMICS 119 


Example 4.1: Consider the oblate disk of mass m and radius r rolling on 
the level surface as shown in Figure 4.3. The disk is attached to a vertical 
shaft through a massless rod of length LZ. This horizontal rod is clamped to 
the center of the disk and pinned to the vertical shaft which is rotating at 
a constant rate ¢. What is the normal force N that the surface is exerting 
onto the disk? 





Figure 4.3: Oblate Disk Rolling on Level Surface 


Let the coordinate frame B : {br, bo, b } be attached to the rolling disk, 
E : {é1, Eg, €3} be attached to the rotating support rod and NV : {71, M2, As} 
be an inertial frame. Since the disk is rolling without slip, the angular rate 6 
can be related to the shaft rotating rate d through 


Bee 
0=—¢ 
7 
The angular velocity vectors between the respective frames are 
*/0 
Wen = O13 = $€3 = | 0 
b 
B . 
a Eek L ? 
Wee = —0€, = —— hb, =—— | 0 
r DN 


Let I, be the disk inertia about its spin axis br and J; the transverse inertias, 
then the disk inertia matrix about its center of mass is given in B frame 
components by the diagonal matrix 


0 0 & 


Because the disk is axi-symmetric about the br = é€; axis, for this example 
®I.] = [Ic] must hold. Since the disk is rotating at an offset distance L 
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about the m3 axis, to find the disk inertia matrix about the point O we must 
use the parallel axis theorem in Eq. (4.19). The position vector of the disk 
center of mass is 


R. = Lép = | 0 
0 


The disk inertia matrix [Jo] about point O is then given in € frame compo- 
nents by 


eRe 0 0 


lo] = [Ice] + m[R-][R-]7 = |0 Kk+mL? 0 
0 0 i+mlL? 


The angular momentum vector Ho of the disk about the point O is the sum 
of the angular momentum due to the shaft rotation about the 73 direction 
and the rolling about the by direction. 


Ho = [Iclwpye + Lolwesnw 
Des : 
=—I,— dé, + (E+ mL”) org 


The inertial angular momentum vector rate Ho is found using the transport 
theorem. 





Pio Bass: ee ed 2) 1 
Ho =-— (1.24e:) = wey x Is den + ( 4+mL a) 
a IL 12a 
mi 0 ee 


The normal force is defined as N = Né3 and the gravity force is given by 
Fy = —mgé3. The torque about point O due to these forces is 


Lo = R. x (F, +N) = L(mg— N) 4 


Note that by taking all moments about point O the reaction forces of the pin 
joint at point O don’t appear. Using Euler's equation Ho = Lo the normal 
force component N can be solved for. 


I; , 
N=mg+—¢ 


The polar moment of inertia of a circular disk of mass m and radius r is 


I, = or 


which allows N to be written as 


am (438) 
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Eq. (4.15) is valid for any choice of body fixed coordinate axes with their 
origin at the body center of mass. Note that the inertia matrix [I] is calcu- 
lated for a specific coordinate system. Let the reference frames B and F both 
be proper body fixed coordinate systems. All angular velocities are measured 
relative to an inertial reference frame NV. Let the direction cosine matrix [FB] 
transform vectors written in the 6 frame into vectors expressed in the F frame. 
Therefore, using Eq. (3.17) we can write 


TH, = |F B\PH. (4.20) 
Jay = [F BlPw (4.21) 


Let us use the following notation. The matrix 7[J] is the inertia matrix written 
in the respective F frame and 4{J] is the inertia matrix in the B frame. Eq. (4.15) 
can then be written as 


BH, = 71] 8a (4.22) 
which is expanded using Eqs. (3.18), (4.20) and (4.21) to 
FH, = [FB] 51] [FB]? %w =7 [0] % (4.23) 


Thus, an inertia matrix written in the 6B frame is rewritten into the F frame 
through the similarity transformation 


7{] = [FB] 41] [FB]" (4.24) 


Whereas Eq. (3.17) maps a vector written in one frame into a vector expressed 
in another frame, Eq. (4.24) performs the analogous operation for matrices. It 
allows matrices with components taken in one frame to be expressed with com- 
ponents taken in another frame through the use of the corresponding direction 
cosine matrix between the two frames. 

Given this similarity transformation, the following question arises. Is there 
a judicious rotation matrix [C] which will rotate the current coordinate frame 
B into a new frame F such that the inertia matrix in this F frame is diagonal? 
The answer to this is yes, this is always possible. Let’s define 7[J] to be diagonal. 
Then Eq. (4.24) can be rewritten as 


Cu Ci2 C13 = In ti he = th 0 O} [Cu Ci2 Cig 
Cr C22 C23 Tig Tee Ia3| = 0 In O] |Car C22 C3} (4.25) 
C31 C32 C33 hg 123 33 0 O I3} [C31 C32 C3 

















After carrying out the algebra and equating the proper components, Eq. (4.25) 
can be reduced to 


B 
In tio hal [Gi C; 


Tyo Ing Tag} | Cia | = Tg | Ci (4.26) 
Nig og Isa} \Ci Ci 


122 EULERIAN MECHANICS CHAPTER 4 


for i=1,2,3. Studying Eq. (4.26) it is evident that each row of the desired [C] 
matrix is an eigenvector of the 5[J] inertia matrix. Assuming that v; are the 
eigenvectors of ®[J] we have 


T 
Vi 


[C] = [V]" = } vp (4.27) 
v3 

The diagonal entries of the new *[J] are the eigenvalues of the old [J] matrix. 
Note that the eigenvectors will always be orthogonal since [C] is an orthogonal 
rotation matrix. The new set of body fixed coordinate axes whose inertia ma- 
trix is diagonal are called the principal axes. Many analytical problems only 
consider the simpler case of diagonal inertia matrices since they assume that 
the appropriate coordinate transformation has already been done. However, in 
practice it is often difficult to find the exact principal axes of a given body. Here 
a set of coordinate axes are typically chosen that are close, but not perfectly 
aligned with the principal axes. The resulting inertia matrix will have dominant 
diagonal and small off-diagonal terms. 


Example 4.2: Find the rotation matrix [C] that will transform the current 
coordinate frame to a new frame F which diagonalizes the inertia matrix 


3 1 £1 
(j= ]1 5 2 
Ly De A 
Using Matlab, the eigenvector matrix [V] and eigenvalue vector A are found 
to be 
0.32799 0.59101 0.73698 7.04892 
[V] = | 0.73698 0.32799 —0.59101 A = | 2.30798 
0.59101 —0.73698 0.32799 2.64310 


Note numerical software packages will not necessarily return eigenvectors of 
unit length. If they are not unit length, they would have to be normalized at 
this point. In our case the eigenvectors returned are already of unit length. 
Secondly, we must verify that the set of eigenvectors {v1, v2, v3} form a right- 
handed set. By inspection it is clear that our first eigenvector v1 crossed with 
the second eigenvector v2 does not yield the third eigenvector v3, but rather 
—v3. To correct this we change the sign of v3 by simply reversing the sign 
of each element of the third column of [V]. The proper, orthogonal, right- 
handed [V] matrix is then 


0.32799 0.59101 —0.73698 
[V] = | 0.73698 0.32799 0.59101 
0.59101 —0.73698 —0.32799 


Since each row of the desired [C] matrix is an eigenvector of [I], then 


0.32799 0.73698 0.59101 
[C]=[V]7 =| 0.59101 0.32799 —0.73698 
—0.73698 0.59101 —0.32799 
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The new principal inertia matrix components are the eigenvalues of [J]. 


FT, = 7.04892 "Ig = 2.30798 7I3 = 2.64310 


4.1.3. Euler’s Rotational Equations of Motion 


Given the previous results, the equations of motion of a rigid body can be 
developed in a very straight forward fashion. Using the transport theorem, 
Euler’s equation is expressed as 
: By 
AH. = qa (He) + x AH. =L, (4.28) 
Using Eqs. (4.15) and the fact that [J] is constant as seen from the B frame for 
a rigid body, the derivative of the angular momentum vector H, as seen in the 
B frame is written as 
Bd Bd Ra 
— (A.) = — (I I|— 
= (He) = > ((N) w + [> 
The last step in Eq. (4.29) is true since the derivative of the body angular 
velocity vector w is the same as seen in the B and the N frame. 
Md Bd Bd 


w= 7 w)=Z w)twxw= = w) (4.30) 


Substituting Eqs. (4.15), (4.29) into Eq. (4.28) yields 
L, = [Jo+w x ([I]w) (4.31) 


(w) = [Jw (4.29) 


Using Eq. (3.23), the famous Euler rotational equations of motion are* 


[Tw = —[a][T]w + Le (4.32) 


By choosing a body fixed coordinate system which is aligned with the principal 
body axes, the inertia matrix [J] will be diagonal and Eq. (4.32) reduces to? 


Tia = —(I33 — I22)wow3 + Ly (4.33a) 
IgQW9 = —(Ti — Is3)w3w1 oT Lg (4.33b) 
Ts3W3 = —(I22 — T11)wiwe + Ls (4.33c) 





For the special case where the body is axially symmetric and no external 
torques are present, the the rotational equations of motion in Eq. (4.33) are 
reduced to 

Iqpwy, = —(Is3 = Ip )wows (4.34a) 
Iqpwo = (133 me Ip)w3w1 (4.34b) 
I33w3 =0 (4.34c) 
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where the transverse inertia Ip is given by 
Ip = Ih, = In2 (4.35) 


From Eq. (4.34c) it is clear that body angular velocity component w3 along 
the axis of symmetry will remain constant. Using this fact while differentiating 
Eq. (4.34a) and substituting Eq. (4.34b), a second order differential equation 
for w, is found: 


I 
cy + ee — 1)?ww, = 0 (4.36) 


Similarly, we can find the second order differential equation of w2 to be 


I. 
ig + (8 — 1)?w2we = 0 (4.37) 
eR 
Note that these differential equations have the standard form of undamped 
oscillators. Therefore the solution of w1(t) and w(t) are given by 





w1(t) = A; coswpt + By sinwpt (4.38a) 
we(t) = Ag cos wyt + Bo sin wyt (4.38b) 
where wy, is defined as 
I. 
Wy = (2 a 1) ws (4.39) 
It 


Let w;, be the initial body angular velocity components , then the constants Ay 
and A» must be 


Ay = Wio Ag = W229 (4.40) 


Differentiating Eqs (4.38a) and (4.38b) and substituting them into Eqs. (4.34a) 
and (4.34b), the constants By and Bz are found to be 


By =—A By = Ay (4.41) 


The closed form solution of the body angular velocity components are given for 
this axially symmetric, torque-free case through 


w31(t) = wy, COS Wpt — Wo, SiINWpt (4.42a) 
wo(t) = wa, COS Wpt + Wi, SINWpt (4.42b) 
w3(t) = ws, (4.42c) 


4.1.4 Kinetic Energy 


The kinetic energy of a continuous system is shown in Eq. (2.84) to be 


Pe ee en A 
T=5MR,-Re+5 | ¢- #dm = Tirans + Trot (4.43) 
B 
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Since we are now only dealing with non-deformable rigid bodies, the kinetic 
energy component T}o; only describes the rotational energy of the rigid body B. 


1 
Trot = = | p-rdm (4.44) 
2JB 


After substituting Eq. (4.8), the rotational kinetic energy of a rigid body is 
expressed as 


Trot = a (wxr)-(wxr)dm (4.45) 


After making use of the trigonometric identity 
(a x b)-c=a-(bxc) (4.46) 


the rotational kinetic energy is rewritten as 


Tea =e | rx(wxr)dm (4.47) 
2 B 


Note that the integral is exactly equal to H, in Eq. (4.9). Therefore, after 
using Eqs. (4.9) and (4.15) the rigid body rotational kinetic energy expression 
is simplified to the form 
1 i 
Pes = 5 : Hi, = a [T]w (4.48) 


The total kinetic energy of a rigid body B is the sum of translational and 
rotational energy as shown in Eq. (4.43) and is given by 


1 : : 
T= 5MR.- Re + 5 [Mw (4.49) 


To find the work done onto a rigid body B, let us find the derivative of 
Eq. (4.48). 


. 1 1 ; 
Trot — 5” g A + a : HA. (4.50) 
Using Eq. (4.1) and (4.15) this is rewritten as 

ieee 1 

Trot = 5 [Tw + ge Le (4.51) 


After substituting Eq. (4.32) and simplifying the resulting expression, the rota- 
tional kinetic energy rate for a rigid body is found to be 


Trop = w- Le (4.52) 
Using Eq. (2.87), the total kinetic energy rate is then given by 


T=F-R.+L.-w (4.53) 
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If the force vector F' is conservative and due to a potential function V.(R,) and 
the torque vector LD, is also conservative and due to a potential function Vr, 
then Eq. (4.53) can be written as 


dT es dV.  dVr 
dt dt dt 
which states that the total system energy EF = T + V. + Vr is conserved in this 
case. 
To find the work W done onto the rigid body 6B between two time steps, 
Eq. (4.53) is integrated once to yield 


=0 (4.54) 





t2 : ta 
ti ty 


Example 4.3: Let us investigate the dynamical system shown in Figure 4.4 
where one solid disk of radius r and mass m™ is rolling off another disk of 
radius R without slip. The coordinate frame NV = {771, ri2, 743} is an inertial 
frame with it’s origin O attached to the center of the stationary disk of radius 
R. A second coordinate from E€ = {€,, €9, 63} has the same origin O. Note 
that e, tracks the heading of the disk center O’ relative to O. The angle 6 
specifies the angular position of the disk center O’, while the angle ¢ defines 
the orientation of the rolling disk relative to the inertial 72 axis. 








Figure 4.4: Disk Rolling Off Another Disk 


Since the disk rolls without slip, the angles 9 and ¢ must be related through 
(R+r)6=r¢ 


First, let’s find an expression for the normal force that the lower disk exerts 
onto the rolling disk. The center of mass position vector of the rolling disk is 
given through 


re = (R+1r)é, 
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The angular velocity of the disk center of mass to the V frame is 
Wein = 663 


Upon differentiating 7, the inertial velocity and acceleration of the disk center 
of mass are found to be 


he = (R+r) 0p 
* =—-(R+r)0°é,+(R+r)bE, 


Let N be the normal force component acting along the é, direction and Fy 
be the frictional force component acting along the €g direction. Considering 
the constant gravity field case, the total force vector acting on the rolling disk 
is given by 


F = (N — mgcos 6) é, + (mg sin 6 — Ff) é9 
The Super Particle Theorem for a continuous body states that 
mro=F 

which leads to 
—m(R+17)6°é, +m(R+r)0€9 = (N — mgcos 8) é, + (mg sin 6 — Fy) €o 
Equating é, and ég components expressions are found for the normal force 
component N and the friction component F’r. 

N =mgcos@ — m(R+r)6" 

Fy = mgsin@ — m(R+r)6 


To write Fy purely in terms of @ and not 6 we study the rotational motion of 
the disk about its center of mass. The torque Lc, experienced by the disk is 


Lo =rFy¥ 
For this simple planar disk Euler’s rotational equations of motion simplify to 
Ie@ = Lor = Fy 
where IJ, is the polar mass moment of inertia of the disk given by 
m 2 


lea, 


Using the relationship d= Btrg the angular acceleration 6 is expressed as 


~— mR+r) 


The friction force component F's can now be expressed as 


1 
Fp= gg sin 0 
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Note that the friction component only depends on the angle 0, and not on 
the disk radius r. The only assumption made here is that the disk inertia 
satisfies the formula used for I. 


To find at what angle @ the rolling disk will leave the lower disk, the normal 
force component JN is set to zero. This leads to the first condition that 0 
must satisfy when the disk leaves the surface. 


mg cos = m(R+1)6" 

Let the scalar function V (0) be the potential function of the rolling disk. 
V(6) = mg(R+1) cosé 

The kinetic energy of the disk is given by 


1 1 . : 
T= sme: Fe + glee” = sm (Rr) 


Recall that ¢@ is measured relative to an inertial axis. Since the dynamical 
system is conservative, the total energy is conserved. The initial energy Ep is 
Eo =mg(R+r) 


The total energy at @ is 
3 2 42 
E=mg(R+r)cosé+ qk +r) 0 


Equating the two energy states leads to the expression 


(2 = ey — cos 6) 

3° (R+r) 
Substituting this 6? into the first condition on 0 (setting the normal force 
component N equal to zero) leads to 


9=cos ! @ = 55.15 degrees 


Thus the normal force component becomes zero at the same angle of 0 
regardless of the disk mass m and radius r. Again, the underlying assumption 


is that J. = By? is satisfied. 


4.2 Torque-Free Rigid Body Rotation 


4.2.1 Energy and Momentum Integrals 


If no external torques are acting on a system, then Eqs. (2.38), (2.72) and 
(2.101) show that the total angular momentum vector H is constant. This 
truth does not depend on whether the system is a single particle, a collection 
of particles or a continuous body. If no external forces are present, then the 
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rigid body rotational kinetic energy will also be a constant as seen in Eq. (4.52). 
Let us write the the angular momentum vector H in terms of body frame B 
components as 


H =H = Hb, + Hob2 + H3b3 (4.56) 


Note that H is a derivative taken relative to the inertial reference frame N. 
Since H = 0, the angular momentum vector will appear constant only when 
seen from the inertial V frame. Relative to the body fixed B reference frame, the 
vector H will generally not appear to be constant but rotating. Therefore the 
B frame H; vector components will be time varying. However, the magnitude 
of H will be constant in all frames. 

The present discussion will assume that the body fixed coordinate axes are 
all aligned with principal inertia axes, therefore the rigid body inertia matrix 
is diagonal. For notational compactness, let us use the short-hand notation 
I, = I,;. The angular momentum vector is then written as 


A, 7 Iw 
H="H= | Ho) = |[ how (4.57) 
Az I3w3 


Since the angular momentum magnitude is constant, all possible angular veloc- 
ities must lie on the surface of the following momentum ellipsoid. 


H? — A’ A = Pot + Bo + Bee (4.58) 


Because the kinetic energy is constant too, the angular velocities must also lie 
on the surface following energy ellipsoid. 


T= shut + 5 QW + shou} (4.59) 
Thus, the dynamical torque-free rotation of a rigid body must be such that 
the corresponding body angular velocity vector w(t) satisfies both Eqs. (4.58) 
and (4.59). The geometric interpretation of this is that w(t) must lie on the 
intersection of the momentum and energy ellipsoid surfaces. 

To more easily visualize the intersection of these two ellipsoids, they are writ- 
ten in terms of the 6 frame angular momentum vector components H; instead 
of the body angular velocity vector components w;. Using H; as independent 
coordinates, the momentum ellipsoid becomes the momentum sphere 


H? = H? + H3+ H3 (4.60) 
and the energy ellipsoid is written as 


_ Hi? Hf | 
nT 2bT 2157 











(4.61) 
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where /2/;7 are the corresponding semi-axes. In order for the torque-free 
rotation to satisfy both Eqs. (4.60) and (4.61), the energy ellipsoid and the mo- 
mentum sphere must intersect. The intersection forms a trajectory of feasible 
w(t) as illustrated in Figure 4.5. This geometrical interpretations is very use- 
ful to make qualitative studies on the nature and limiting properties of large 
rotations. 
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Figure 4.5: General Intersection of the Momentum Sphere and the En- 
ergy Ellipsoid 


Clearly, for a given |H]|, only a certain range of kinetic energy is possible. 
For the current discussion, let us hold the angular momentum vector magnitude 
constant and sweep the kinetic energy through its two extrema. Also, assume 
that the inertia matrix entries J; are ordered such that 


Ty => In = Iz (4.62) 


With this ordering of inertias, the largest kinetic energy ellipsoid semi-axis 
V2T occurs about the 6; axis as shown in Figure 4.5, and the smallest semi- 
axis is about the 63 axis. Eq. (4.61) shows that varying T will only uniformly 
scale the corresponding kinetic energy ellipsoid. The overall shape and aspect 
ratio of the ellipsoid will remain the same for each choice in T. 

Three special energy cases are shown in Figure 4.6. Since the kinetic energy 
ellipsoid and the momentum sphere must intersect, the smallest possible T’ would 
be scaled the energy ellipsoid such that its largest semi-axis is equal to H = 
||. The momentum sphere perfectly envelops the energy ellipsoid as shown in 
Figure 4.6(i). The only points of intersection are at 


5H = +Hb, (4.63) 





TORQUE-FREE RIGID BODY ROTATION 131 


SECTION 4.2 






Gi j 
\\ 
\ 


ratrix Z <% | 
LETT LY 
LA 

Vae 



























(i) Minimum Energy Case 


i 






aN 














SN 
AS 
A 





fl 




















WN 
OY 


N 
HE Ry 
LL 


\\ 
o 
ss 


\ 
\ 
SS 


> 
LT} 
as 








Ee? 












\\\ 








IK] 
LL 


dg 





(iii) Maximum Energy Case 


Figure 4.6: Special Cases of Kinetic Energy Ellipsoid and Momentum 


Sphere Intersections 
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Therefore, for this minimum kinetic energy case, the rigid body 6 is spinning 
purely about its axis of maximum inertia b, and the corresponding kinetic 
energy is 
2 
Lan = (4.64) 

As the kinetic energy T is enlarged, the next special case arises when the 
intermediate energy ellipsoid semi-axis is equal to H as shown in Figure 4.6(ii). 
The intersection curve between the momentum sphere and the energy ellipsoid 
is called the sepratrix. The kinetic energy for any motion along the sepratrix is 
given by 

2 
Tint = 5 (4.65) 

Note that any small departure from the pure spin case about the intermediate 
inertia axis by will result in general “tumbling” motion. This result agrees well 
with the common experience that it is very difficult to throw an object into the 
air and have it spin purely about the intermediate inertia axis without starting 
to turn and twist about the other axes. 

As the kinetic energy is enlarged to its largest possible value, the correspond- 
ing kinetic energy ellipsoid perfectly envelops the momentum sphere as shown 
in Figure 4.6(iii). This maximum kinetic energy case 


H? 


Tmaz SA 
OTs 


(4.66) 


corresponds to a pure spin about the smallest axis of inertia bs since the only 
intersection point is at 


5H = +Hb; (4.67) 





For a general rigid body motion as shown in Figure 4.5, once the initial 
kinetic energy T and angular momentum vector H are established, the angular 
velocity vector w will theoretically trace out a particular intersection curve 
forever. The assumption here is that the body B is perfectly rigid and that 
no energy is lost (ie. no internal dampening, heat loss, ...). However, this 
assumption is highly idealistic. No body is perfectly rigid and devoid of internal 
damping. Therefore real rigid bodies spinning in a torque free environment do 
actually lose energy, though typically at a slow rate. 

Figure 4.7 shows a family of energy ellipsoid and momentum sphere inter- 
sections for varying levels of kinetic energy. Note that except for the sepratrix 
case, all feasible w(t) paths form closed trajectories. A typical example of a 
torque-free rigid body rotation would be a rigid satellite launched into an Earth 
orbit. Once the satellite is spun up about a particular axis and the thrusters are 
shut down, the satellite won’t experience any external torques and the H vector 
will remain constant. We are ignoring here the affects of atmospheric and solar 
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Figure 4.7: A Family of Energy Ellipsoid and Momentum Sphere Inter- 
sections 


drag. Let’s study what happens if a satellite is spun up about the axis of least 
inertia 63. For a given angular momentum, this corresponds to the maximum 
kinetic energy case. Since any real rigid body will loose energy over time simply 
due to internal damping, this satellite’s energy is expected to decrease over time. 
Figure 4.7 shows how the satellite will start to “wobble” about the b3 axis as 
the energy ellipsoid is reduced. After some time the w(t) curves will cross the 
sepratrix and the satellite will start to “wobble” about the axis of maximum 
inertia by. Ultimately, as the energy approaches the minimum energy ellipsoid, 
the satellite will be spinning purely about the by axis. Therefore, under the 
presence of a negative energy rate, only the spin about the axis of maximum 
inertia is a stable spin. The pure spin case about b3 will become unstable over 
time. 

This behavior is demonstrated in nature in that all planets are essentially 
spinning about their axis of maximum inertia. This fact was rediscovered during 
early space explorations when Explorer 1 was launched into orbit spinning about 
its axis of least inertia. It took less than a fraction of an orbit before it started 
to tumble. 


4.2.2 General Free Rigid Body Motion 


In this section we would like to derive the general rotational equations of motion 
for a rigid body free of any external torques. The attitude coordinates are chosen 
to be the (3-2-1) Euler angles, also known as the yaw, pitch and roll angles 
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(w, 6, 6). However, the method used here to derive the equations of motion could 
be used for any set of attitude coordinates presented in Chapter 3. Assume the 
rigid body has a coordinate system 6B attached to it which is aligned with the 
principal inertia axes and let NV be an inertial reference frame. For the free 
motion of a rigid body the angular momentum vector H will remain constant. 
Using a trick due to Jacobi, we can therefore always align our inertial space unit 
axes n,; such that m3 is aligned with —H. 
” 0 
H =H =Hnhaz= | 0 (4.68) 
—H 


The direction cosine matrix [BN] translates any vector written in NV frame 
components into a vector in 6 frame components as shown in Eq. (3.17). 


5H = (|BN|SH (4.69) 
The direction cosine matrix in terms of the (3-2-1) Euler angles is given in 


Eq. (3.33). After using Eq. (4.68) to carry out the matrix multiplication and 
equating the resulting 6 frame components to Eq. (4.56) we obtain 


Ay = Hsin@ = Tywy (4.70a) 
Hy = —Hsindcosé = Inwe (4.70b) 
H3 = —H cos ¢cos@ = [3w3 (4.70c) 


which can be solved for the body angular velocity vector w as 


# sin 0 Wy 
—Hsindcosé } = | we (4.71) 
—F cos bcos O W3 

3 


To find an expression for the individual Euler angle rates (a, 6, d), we substitute 
Eq. (3.55) into Eq. (4.71) and obtain the following equations of motion for a 
torque-free rigid body. 








: 2 2 
(5 sin* if Q (4.72a) 
Ig I 
» Afi 1 
0 =——— eS et 34 . . 
5 (+ z) sin 2@cos 0 (4.72b) 
: 1 sin?¢ cos? ; 


Note that w in Eq. (4.72a) cannot be positive, while 6 and ¢ can have either 
sign. 
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4.2.3, Axisymmetric Rigid Body Motion 


The equations of motion in Eqs. (4.72) are valid for a general rigid body with 
the body fixed axes aligned with the principal inertia axes. Now we would 
like to study a particular case of these equations where the rigid body is is 
axisymmetric. Without loss of generality, assume that Iz = Ig. Then the yaw, 
pitch and roll angle rates in Eqs. (4.72) simplify to 


. Al 
a (4.73a) 
In 
6=0 (4.73b) 
; Ib-h)\. 
= ——— 5 0 4, 
@=H ( Lb ) sin (4.73c) 


Having chosen the inertial angular momentum vector NF to be in the positive Ag 
direction, the precession rate w will be a positive constant for an axisymmetric 
rigid body. The relative spin rate db is also a constant like precession rate. 
However, the sign of ¢ in Eq. (4.73c) depends on the relative size of I; and Iz and 
on the pitch angle 6. On the other hand, the pitch rate 6 is zero for axisymmetric 
rigid body rotations, therefore the pitch angle 6 will remain constant throughout 
the motion. 








Figure 4.8: Angular Velocity and Momentum Vector Relationship for 
the Case Iz > Ih 


Let 2“ = w; be the body spin rate about its axis of symmetry by as shown 
in Figure 4.8. Using Eq. (4.70a) it is expressed as 


A 
Q= sing (4.74) 
qi 
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For a positive pitch angle 0 < 6 < 2/2 the body spin rate Q about the sym- 
metry axis must be positive. Instead of being written in terms of the angular 
momentum magnitude H, the precession rate w and the relative spin rate db can 
now be expressed in terms of 2 as 


iQ 
Ip sin 0 
In-Ty 
= — 1) 
Lp 





(4.75) 


ob (4.76) 
The angular momentum vector along the axis of symmetry b; is labeled in 
Figure 4.8 as Hq. It is defined as 


H, = Ob; (4.77) 


As is easily seen in Figure 4.8, for positive pitch angles 6 and Iz > 1, the 
axisymmetric rigid body B will have a positive spin rate about by. 

Since the pitch angle @ is shown to remain constant during this torque-free 
rotation, the resulting motion can be visualized by two cones rolling on each 
other. Figure 4.9 shows the two cases where either Iz > J, or Ig < Ih. 
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Figure 4.9: Conic Illustration of Direct and Retrograde Precession of a 
Freely Rotating Rigid Body 


The space cone is fixed in space and its cone axis is always aligned with the 
angular momentum vector H. The cone angle (3 is defined as the angle between 
the vectors H and w. The body cone axis is aligned with the body axis by and 
has the cone angle a which is the angle between w and b,. If Iz > I, then the 
body cone will roll on the outside of the space cone as shown in Figure 4.9(i) 
and the resulting motion is called a direct precession. If Iz < I, then the space 
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cone will lie on the inside of the body cone and the resulting motion is called a 
retrograde precession. 


4.3 Momentum Exchange Devices 


Instead of using thrusters to perform precise spacecraft attitude maneuvers, typ- 
ically control moment gyros (CMGs) or reaction wheels (RWs) are used. Either 
devices can change its internal angular momentum vector and thus, through 
Euler’s equation, produce an effective torque on the spacecraft. A single-gimbal 
CMG contains a wheel spinning at a constant rate. To exert a torque onto the 
spacecraft this wheel is gimbaled or rotated about a fixed axis.>° The rotation 
axis and rotation angle are referred to as the gimbal axis and gimbal angle re- 
spectively. A separate feedback control loop is used to spin up the rotor to the 
required spin rate and maintain it. The advantage of a CMG is that a rela- 
tively small gimbal torque input is required to produce a large effective torque 
output on the spacecraft. This makes CMGs a very popular devices for reori- 
enting large space structures such as the space station. The drawback of the 
single-gimbal CMGs is that their control laws can be fairly complex and that 
such CMG systems encounter certain singular gimbal angle configurations. At 
these singular configurations the CMG cluster is unable to produce the required 
torque exactly, or any torque at all if the required torque is orthogonal to the 
plane of allowable torques. Several papers deal with this issue and present var- 
ious solutions.> © However, even with singularity robust steering laws or when 
various singularity avoidance strategies are applied, the actual torque produced 
by the CMG cluster is never equal to the required torque when maneuvering in 
the proximity of a singularity. The resulting motion may be stable, but these 
path deviations can be highly undesirable in some applications. Double-gimbal 
CMGs have fewer problems with singularities. However, they are also much 
more costly and complicated devices than the single-gimbal CMGs. 

Reaction wheels, on the other hand, have a wheel spinning about a body 
fixed axis whose spin speed is variable. Torques are produced on the spacecraft 
by accelerating or decelerating the reaction wheels.!' 7 RW systems don’t have 
singular configurations and typically have simpler control laws than CMG clus- 
ters. Drawbacks to the reaction wheels include a relatively small effective torque 
being produced on the spacecraft and the possible reaction wheel saturation. To 
exert a given torque onto a spacecraft, reaction wheels typically requires more 
energy than CMGs. 

Variable Speed Control Moment Gyroscopes (VSCMGs) combine positive 
features of both the single-gimbal CMGs and the RWs. The spinning disk can 
be rotated or gimbaled about a single body fixed axis, while the disk spin rate is 
also free to be controlled.®: ° This adds an extra degree of control to the classical 
single-gimbal CMG device. Note that adding this variable speed feature would 
not require the single-gimbal CMG to be completely reengineered. These devices 
already have a separate feedback loop that maintains a constant spin rate. What 
would need to be changed is that the torque motor controlling the RW spin rate 
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would need to be larger, and the constant speed law abandoned. With this extra 
control singular configurations, in the classical CMG sense, will not be present. 
This section will first develop the equations of motion of a spacecraft containing 
VSCMGs using Euler’s equation. The resulting formulation contains the two 
classical cases of having either pure RWs or CMGs. 
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Figure 4.10: Illustration of a Variable Speed Control Moment Gyroscope 


4.3.1 Spacecraft with Single VSCMG 


To simplify the development and notation, the rotational equations of motion 
are first derived for the case where only one VSCMG is attached to a rigid 
spacecraft. Afterwards, the result is expanded to incorporate a system of N 
VSCMGs. Let G be the gimbal reference frame whose orientation is given by the 
triad of unit vectors {9s, 9:, Gg} as shown in Figure 4.10. The vector components 
of the unit vectors g; are assumed to be given in the spacecraft reference frame 
B. Note that since the VSCMG gimbal axis g, is fixed relative to B, only the 
orientation of the spin axis g, and the transverse axis g; will be time varying as 
seen from the B frame. Given an initial gimbal angle yo, the spin and transverse 
axis at a gimbal angle 7(t) are given by 


Gs (t) = cos (y(t) — Yo) Gs (to) + sin (y(t) — 70) Ge (to) (4.78) 
91 (t) = — sin (7(t) — 70) Gs (to) + cos (y(t) — Yo) Ge (to) (4.79) 


The spin rate of the VSCMG about g, is denoted by 2. The angular velocity 
vector of the G frame relative to the B frame is 


wg /B = YGq (4.80) 
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The angular velocity vector of the reaction wheel frame W relative to the gimbal 
frame G is 


wwg = 29s (4.81) 


To indicate in which reference frame vector or matrix components are taken, 
a superscript letter is added before the vector or matrix name. Since the G frame 
unit axes are aligned with the principal gimbal frame axes, the gimbal frame 
inertia matrix [Ig] expressed in the G frame is the constant diagonal matrix. 


“he, 308 50 


[fe] = * [Ie] = : Ja 2 (4.82) 
G 


g 


where Ig,, Ig, and Ig, are the gimbal frame inertias about the corresponding 
spin, transverse and gimbal axes. The reaction wheel inertia about the same 
axes are denoted by Iw, and Iw, = Iw,- 


sd 0 
Fala ge Oe. hye 0 (4.83) 
0 oO Ty, 


Note that since the disk is symmetric about the g, axis [Iw] = 9[Jw]. In 
practice Iw, is typically much larger than any of the other gimbal frame or 
RW inertias. In this development the RW and gimbal frame inertias are not 
combined early on into one overall VSCMG inertia matrix; rather, they are 
retained as separate entities until later into the development. This will allow 
for a precise formulation of the actual physical motor torques that drive the 
RWs or the CMGs. 

The G frame orientation is related to the B frame orientation through the 
direction cosine matrix [BG] which is expressed in terms of the gimbal frame 
unit direction vectors as 


[BG] = [9s 9 Go] (4.84) 


In Eq. (4.84) the g; vector components are taken in the 6 frame. The rotation 
matrix [BG] maps a vector with components taken in the G frame into a vector 
with components in the B frame. The constant diagonal inertia matrices 9 [Jc] 
and ¥[Iy] are expressed with components taken in the B frame as the time 


varying matrices”: 1° 
“cl = [BG] 9 Ue] [BG]" = Ic.9565 + 1e.G:87 + 1e,9o9¢ (4.85) 
Uw] = [BG] ° Uw] [BG]" = Iw.9s95 + Iw. G97 + 10.9995 (4.86) 


The total angular momentum of the spacecraft and the VSCMG about the 
spacecraft center of mass is given by 


A=He+He+Aw (4.87) 
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where He is the angular momentum component of the spacecraft, Hg is the 
angular momentum of the gimbal frame and Hy is the angular momentum of 
the RW. Let NV be an inertial reference frame and wg, be the relative angular 
velocity vector, then Hg is written as 


Hy = [Lean (4.88) 


The matrix [J,] contains the spacecraft inertia terms and the VSCMG inertia 
components due to the fact that the VSCMG center of mass is not located at 
the spacecraft center of mass. Note that 8[J,] is a constant matrix as seen from 
the B frame. The gimbal frame angular momentum Hg is given by 


Ag = UTalwe nv (4.89) 


where wg/y = Wg/gp + Wey. Using Eqs. (4.80), (4.82) and (4.85) this is 
rewritten as 


He = (16.99) +1e,69¢ + Ic,999,) “ew + 10,495 (4.90) 


To simplify the following notation, let the variables w., w; and wg be the pro- 
jection of wg ,y onto the G frame unit axes. 


Ws = Gg. WB/N (4.91a) 
wt = Gf WB/N (4.91b) 
Wg = 9) WB/N (4.91c) 


The angular momentum Hg is then written as 
He = I¢,WsG9s + Ia,wig + Ia, (Wg +9) Gg (4.92) 
The RW angular momentum Hy is given by 
Aw = Iwlewyw (4.93) 


where wy jy = Wyy/g + Wg/g + wpe. Using analogous definitions as for He, 
Ay is rewritten as 


Hy = Ty, (ws + 2) Gs + Iw,“Gt + Iw, (wa + 9) Go (4.94) 


To simplify the notation from here on, let us use the short hand notation 
w = w/v. In some calculations it will be convenient to express w in the G 
frame as 


Guy = WsGs aS weGt ate: WoGg (4.95) 
The equations of motion of a system of rigid bodies follow from Euler’s equation 


H=L (4.96) 
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if all moments are taken about the center of mass. The vector E represents the 
sum of all the external torques experienced by the spacecraft. To find the inertial 
derivatives of Hg and Hy, the inertial derivatives of the vectors {9s, 9, Gg} 
are required. Using the transport theorem we find 





B 
be = a (Gs) tw x 96 = (V+ Wp) Ge — wide (4.972) 
: By 
be = Gu) Fo x Ge =— (+ U9) Bs + Hed (4.97b) 
. By 
dig = (Gy) + 02 * iy = rds — wad (4.97¢) 


Behe a 

ae (9s) = Yat (4.98) 
Bs des 

i (9) = -795 (4.99) 
By . 

aH (99) = 9 (4.100) 


as can be verified through Eqs. (4.78) and (4.79). The inertial derivatives of the 
G frame body angular velocity components are 





Ws = 9.0 + 9,0 =4uwit+g,w (4.101a) 

i = §, w+ Gre = Ww, + gw (4.101b) 

wg = 9,0 + Grw=9glw (4.101c) 
Using these definitions the inertial derivative of Hw is expressed as 


Hw = 4sIw, (0 + gl w+ wr) 
+ Gr (Iw,4ws + Iw.gP wm + (Iw, — Iw,) seg + Iw. Q(4 + wy) (4-102) 


+ Gy (Iw.99 (w+ 4) + Uw, — Iw.) wswr + Iw, wt) 





Let Lw be the torque the gimbal frame exerts on the RW. Isolating the 
dynamics of the RW, Euler’s equation states that Hw = Ly. The torque 
components in the g; and g, direction are produced by the gimbal frame itself. 
However, the torque component u, about the g, axis is produced by the RW 
torque motor. Therefore, from Eq. (4.102) the spin control torque ug is given 
by 


wate (0 4 @Fa+ jw) (4.103) 


After differentiating Eq. (4.92) and using the definitions in Eqs. (4.97) and 
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(4.101), Hg is expressed as 

He = 9s ((Ic. — Ia, + Ig,) Wwe + Ie.G2 @ + (Ia, — Ic,) wg) 
+ @: (Ic, — Ia, —Ie,) ws + 1e,g7H + Ua, —Ta,)wsvg) (4.104) 
+ Gq (Ia, (954 + 4) + (a, — Ia.) wat) 


From here on it is convenient to combine the inertia matrices of the RW and 
the gimbal frame into one VSCMG inertia matrix [J] as 











“Tile 0 0 
['Y]J=Ue]+Uw]= |0 F 0 (4.105) 
0 0 Jy 


Let Lg be the torque vector that the combined RW and CMG system exerts 
onto the spacecraft, then Euler’s equation states that Ho+ Hw = Lg. The Lg 
torque component about the gg axis is produced by the gimbal torque motor. 
Adding Eqs. (4.102) and (4.104) and making use of the definition in Eq. (4.105), 
the gimbal torque u, is then expressed as 


Ug = Jq (95H +4) — (Js — Jt) woe — Iw, Que (4.106) 
The inertial derivative of Hg is simply 
Hep = [I.Ju + w x [I,J (4.107) 


To further simplify the equations of motions, the total spacecraft inertia matrix 
[I] is defined as 


[7] = Us] + [J] (4.108) 


Substituting Eqs. (4.102), (4.104) and (4.107) back into Eq. (4.96) and making 
use of the definition in Eq. (4.108), the equations of motion for a rigid spacecraft 
containing one VSCMG are 


[Tea = —w x [Teo — G5 (Joie + Iw.2 = (Jr - Jg) wr') 
= 1 (Jews + Iw,2) 7 — (Je + Jg) wey + Tw, Qw,) (4-109) 
— Gg (IgV — Iw. Qux) + L 
where the identity 
w x [J]w = (Jg — Jt) wiwgGs + (Js — Jg) WswgGt + (Jt — Js) WswsGg (4.110) 
is used to combine terms into w x [I]w. From here on the common assumption 
will be made that J; ~ Iw,, i-e,. that the gimbal frame inertia Ig, about the 
spin axis is negligible. The corresponding equations of motion are simplified to 
[I] = -w x [Tw — G5 (Js (@+ awe) — Se — Jp) we) 
~ 91 (Js (we + 2)¥—(Se+Jq) wey + JeMw,) (4-111) 
— Gg (Joy — JsQuy) + L 
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Note that the equations of motion in Eq. (4.111) incorporates both classical 
cases of having either a single-gimbal CMG or a RW attached. 


Example 4.4: To reduce the general equations of motion in Eq. (4.111) 
to that of a spacecraft with a single CMG, the RW spin speed is forced to 
remain constant by setting 2 = 0. Quickly the standard single-gimbal CMG 
equations of motion are retrieved to be 


[To = -w x [Tw — gs (Jeter — (Je — Jp) we) 
— gt (Js (ws +2) 4 — (Jt + Jg) Ws + Js QW) 
= G9 (Joy — JsQut) + LE 


This is also the form that is commonly used when designing control laws since 
CMGs are controlled at a gimbal velocity + level. There is no need to have 
the gimbal motor torque ug explicitly present in this formulation. 


To retrieve the RW equations of motion from Eq. (4.111), the gimbal rates 
and accelerations 7+ and ¥ are set to zero. The resulting equations of motion 
of a spacecraft with a single RW attached are 


[Tl = —w x [Tw — gsJsQ — JoQ (woGt — wiGg) + L 
which can be simplified using the cross product operator to be 
[Tw = —w x [Iw — g.J.Q—w x JoNG, + L 


However, many times it is convenient to have these equations of motion 
written in terms of the us instead of Q to which results in control laws 
that directly find the required RW motor torque. The motor torque given in 
Eq. (4.103) is simplified for this case to be 


hig Me (® 9g.) (4.112) 


Extracting the J, component of the inertia matrix [I], the modified inertia 
matrix [[Rw] is defined as 


[Inw] = [Is] + JeGeG? + JoGoG5 


which allows the equations of motion to be written in the standard form terms 
of us.” 


[Trw]w =—-W xX [Trw]w —WX JsQs (ws) a UsQs +24 (4.113) 


4.3.2 Spacecraft with Multiple VSCMGs 


To obtain the equations of motion of a rigid spacecraft with several VSCMGs 
attached, the effects of each Hg and Hw are added up. To simplify notation, 
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let us define the following useful matrices. The 3xN matrices [G5], [G;] and [G,]| 
contain the unit direction vectors of each VSCMG gimbal frame. 


[Gs] = [9s, +: Gsy] (4.114a) 
[Ge] = [Ge +++ Gen] (4.114b) 
[Gg] = [G9o1 -* Gow] (4.114c) 
The total spacecraft inertia matrix is expressed as 
N N 
[1] = [fo] + D- [Fa] = Uo] + So Je Gs.92, + JeG.G0 + JoGod,, (4-115) 
i=1 i=1 


The torque-like quantities T,,, 7, and Tg, are defined as 


Is, (% ae jn) = (St, az Jig.) Wty V1 
= (4.116a) 
Isy (Qn + wey | = (Sty = Jon) Wt YN 
Is, (Q1 - Ws; ) VN = (Je ty Jq:) Ws, V1 7 J 5, QW, 
= (4.116b) 
Isn (Qn + Wsy) YN (Sty ¥ Jon) sn YN a TsyQNWgn 
| Io V1 7 Ig, QW, ] 
T= (4.116c) 
ied = oe 
The rotational equations of motion for a rigid body containing N VSCMGs is 
then written compactly as® 
[T]w = —w x [I]w — [4G]. — [Ge]7: — [Gg]tg + L (4.117) 
The rotational kinetic energy T of a rigid spacecraft with N VSCMGs is 
given by 
1 ee 
c= 50 Lele +5 So Je, (Qi + wWe,)? + Jew? + Ig, (Wo +41)? (4.118) 


2 4 
1 


The kinetic energy rate, also known as the work rate, is found after differenti- 
ating Eq. (4.118) and performing some lengthy algebra to be 
N 
T = wT L+ > ittg, + Qitte, (4.119) 
i=1 
This energy rate for this system of rigid bodies was apriori known from the 
Work-Energy-Rate principle’! shown in Eq. (4.53) and is thus a validation of the 


presented equations of motion. Also, checking the kinetic energy time history 
is a convenient way to check the accuracy of the numerical simulations. 
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Example 4.5: The equations of motion of a spacecraft with several single- 
gimbal CMGs or RWs attached can easily be extracted from Eq. (4.117). This 
example discusses the generalization of Eq. (4.113) for the case of multiple 
RWs. The inertia matrix [[Rw] is now defined as 


N 
[nw] = [Ue] +2 (Judea + Jo.d00% ) 
i=1 


Let the 7th components of the vector ws be the RW motor torques given in 
Eq. (4.112) and let the vector h, be defined as 


hs = | Js, 


The desired equations of motion are then written as 
[Trw]w =—-W xX rw]w —WX [Gs|hs a [Gs]us +21 (4.120) 


Often three RWs are built into a spacecraft such that their spin axis g., align 
with the principal body axis. For this special case the matrix [Gs] is reduced 
to the identity matrix. The equations of motion for this non-redundant RW 
setup are 


rwlw = —w x Trwlw —w xh,—ustL 


While the redundant setup with a general [G',] matrix can accommodate RW. 
failures, the minimal RW setup cannot have one control wheel fail and still 
perform general three dimensional rotations. 


4.4 Gravity Gradient Satellite 


An object in Low Earth Orbit (LEO) does not experience the same gravitational 
pull on all parts of its body. As is described in Newton’s Law of Universal 
Gravitation in Eq. (2.4), portions closer to Earth are attracted more strongly 
than portions further removed. While this force is relatively weak, it is enough 
to stabilize some satellites in a vertical orientation relative to the local horizon. 
The oldest and most famous gravity gradient stabilized satellite in Earth’s orbit 
is the moon. This section will study the effect of the gravity gradient torque on 
a rigid object in an inverse square gravity field. 


4.4.1 Gravity Gradient Torque 


Assume an object 6 is in LEO and its center of mass has the inertial position 
vector R, relative to Earth’s center. Let the vector Lg be the external gravity 
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torque experienced by a rigid object measured about its center of mass. For a 
solid body this torque is defined through Eq. (2.99) to be 


Le= | rx dFg (4.121) 
B 


where the vector r is the position vector of an infinitesimal body element relative 
to the center of mass and Fg is the gravitational attraction experienced by this 
element. Using Newton’s Gravitational Law in Eq. (2.4) this force is written as 


Me 
pam (4.122) 


where M, is Earth’s mass, dm is the body element mass and R is its inertial 
position vector measured from Earth’s center. 


R=R.+r (4.123) 


dFg = — 


Substituting Eq. (4.122) into the Dg expression yields 
GM. 
ie -{ rx 22 (R, +r) dm (4.124) 
B |R 


The R, vector is constant within this integral and can be taken outside. After 
cancelling the r x r term and rearranging the expression slightly, the torque De 
is written as 


Tr 
Lo = GM.R, x i‘ ae api 4.125 
3 [RP ce 


To evaluate the integral, the integral denominator |R|° must be simplified. Let 
R,. and r be the magnitude of the vector R, and r respectively. 


|R|-8 = |R. + rl = (R242R,-rt¢r°) 7? 


—3/2 
1 2R.-r ey” 
Tope eS Re Ne (4.126) 


22 3R.-r 
a ita Pe sit Se 


The approximation in the last step was performed using a binomial expansion 
and dropping the higher order terms. Substituting Eq. (4.126) into Eq. (4.125) 


yields 
GM. 3R.-7r 

















Since by definition the vector r is measured relative to the center of mass, the 
term Tes rdm is zero and drops out. The gravity gradient torque Lg can then 
be written as 


Me 
beens | SG Ran (4.128) 
Re B 
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Using the vector identity 
ax (bx c)=(a-c)b—-(a-b)c (4.129) 
the integrant is rewritten in the form 


3GM, 
Le= Re Rex | — (nxn x Re+ (rr) Re)dm (4.130) 
c B 





After using the definition of the tilde matrix in Eq. (3.23), the torque Dg ex- 
pression is written as 


Le= oeMey: x ( | -tritetam) R,- oe @) dm) R,.x R, (4.131) 








Re Re 


Note that the first integrant is equal to the inertia matrix definition in Eq. (4.14), 
while the second cross product term is zero. Therefore, the gravity gradient 
torque vector Lg acting on a rigid body in an inverse square gravity field is 





written in its most general form as! 1° 
3GM. 
Le = = R, x [I]Re (4.132) 


The only approximation made was the truncation of the binomial series. If the 
inertia matrix [J] is assumed to be of diagonal form, i.e. the chosen coordinates 
axes are the principal body axes, then the gravity gradient torque expression 
can be further simplified. Let the center of mass vector R, be given in body 
frame components as 
B Re, 
Ro.= | Re (4.133) 
Res 
After carrying out the algebra in Eq. (4.132), the simplified gravity gradient 
torque vector is given in B frame components as 





Le, Rey Reg (133 — I22) 

Me 2 3 
Le, | = eh Re, Reg (Li — I33) (4.134) 
Le, g Re, Reg (L22 — [h1) 


Studying Eq. (4.134) it is clear that that several situations will lead to no gravity 
gradient torque being produced on a spacecraft. Symmetric spacecraft with 
Ty, = Ing = I33 have a zero torque Lg vector. Assume that the +th principal 
body axis is asymmetry axis, then the spacecraft will not experience any gravity 
gradient torque about its +th body axis. Lastly, if the center of mass vector R, 
is parallel with any of the principal body axes, then two of the three R., vector 
components will be zero, which results in the Dg vector itself being zero. 
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4.4.2 Rotational - Translational Motion Coupling 


To study the coupling effect of the translational motion of a spacecraft B versus 
its rotational motion and vice versa, the total gravity force vector Fg acting on 
the rigid body needs to be investigated. This force vector determines the center 
of mass motion of the spacecraft. Using Eqs. (2.75) and (4.122) it is written as 


R 
Fo= f dre =-cm, | —sdm 4.135 
B B |RI° ee 


After using the approximation for |R|~? given in Eq. (4.126) and the definition of 
R and expanding the resulting product, the gravity force vector Fg is rewritten 





as 
GM. 3 
Fe =- Rs (fram — Fe [cr Ryans Re fam 
3 


Note that the first term in the parenthesis is zero due to the definition of the 
spacecraft center of mass. Let m be the total spacecraft mass. After using the 
vector identity in Eq. (4.129) Fe is written as 


GM. 
a 


Cc 


Fg = 





3 
(mR. — Fy f (rx x Re +R) am 


— Re: (/. rdm) Re) (4.137) 


where the last term in the parenthesis is zero due to the definition of the center 
of mass. Using the definition of the inertia matrix in Eq. (4.14) the gravity force 
vector of a rigid body in an inverse square gravitational field is expressed 


GM. 3 2 R. 
Fo =- BB (me. + R. G - fe am) ey (4.138) 





Observe that the first term in Eq. (4.138) is the standard gravitational force 
experienced by a body of mass m in Earth’s inverse square gravitational field. 
The second term is due to the gravitational gradient effect. Since typical man- 
made spacecraft are of rather small size compared to their orbital radius R-, the 
gravitational gradient term is always very small compared to the gravitational 
attraction of the center of mass. If the spacecraft 6 is rotating about its center 
of mass, then the unit vector R,/Rc components mapped into the body frame 
B will vary with time. However, this rotation to translation coupling effect is 
negligible and can be ignore for a first order approximation. To study the effect 
of the spacecraft translation onto its rotation Eq. (4.132) is used. Clearly the 
orbit radius R, directly effects the magnitude of the gravity gradient torque 
vector experienced. While Dg is typically a small quantity, its effect can be 
quite substantial on elliptic orbits where R, can vary greatly with time. 
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Figure 4.11: Spacecraft in Circular Orbit 


4.4.3, Small Departure Motion about Equilibrium Attitudes 


Assume a spacecraft B is in a circular orbit O about Earth. The orbit frame 
orientation is defined through the unit vectors 6;, 62 and 63 as shown in Fig- 
ure 4.11. Let the vector R, = R.63 define the spacecraft position measured from 
the Earth’s center. The gravity gradient torque was found to be zero whenever 
the principal body axis where aligned with the orbit frame axis. Therefore, we 
choose for the spacecraft body fixed axes {b} to be nominally aligned with the 
orbit frame {6}. There are 24 possible orientations for a rigid spacecraft to have 
its principal axes aligned with another reference frame. We choose for each b; 
vector to be in the 6; direction. 

Since only small spacecraft rotations about the {6} frame are considered, 
the (3—2-—1) Euler angles (w, 0, ¢)are chosen to describe the relative spacecraft 
attitude to the orbit frame. The orbit frame angular velocity vector relative to 
the inertial frame is given by 


where the magnitude ( is given by Kepler’s equation to be? 1? 
ge _ Me 
es 


Cc 





(4.140) 


The relative angular velocity vector wg/o is written in terms of the yaw, pitch 
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and roll rates using Eq. (3.55) as 


— sin 0 1] (¢ 
w/o = |singcos@ cosd 0] | 6 (4.141) 
cos¢cos? —sing 0 d 


The spacecraft angular velocity vector relative to the inertial frame is 


WBIN = WB/O + WO/N (4.142) 


Using Eq. (3.33), the direction cosine matrix [BO] which relates the O frame to 
the 6 frame is written in terms of the (3 — 2 — 1) Euler angles as 


cOcw cOsy) —s6 
[BO] = | sdsOcw — chsp sdsOsw + chcw sdcO (4.143) 
cosbcw + sdsw chdsOsw — sdcew cdhcb 


Expressing 6) in terms of 6; and substituting Eqs. (4.139) and (4.141) into 
Eq. (4.142), the spacecraft body angular velocity vector is expressed as 


e $ — sin 6) + Qcos 6 sin 


Swine = | sin@cos On) + cos 00 + Q (sin dsin @sin ~ + cos dcos wv) (4.144) 
cos ¢ cos 6 — sin 6) + 2 (cos dsin 6 sin w — sin d cos ) 





From here on the angular velocity wg/y is abbreviated as w. Eq. (4.144) can 
be rewritten to yield the Euler angle rates in terms of the body angular velocity 
w and the orbital rate Q. Using the [B(w, 0, @)| matrix definition in Eq. (3.56) 
we find 


p Q sin @ sin w 
6) = [B(w,4, )]w — —— | cos cosy (4.145) 
‘ cos 6 ain 


It is rather surprising that the algebra reduces to the relatively simple form of 
Eq. (4.145). Using the Euler parameter vector 3 or the MRP vector o as the 
relative attitude coordinates to the orbit frame, even simpler attitude coordinate 
rate expressions are found. Using Eq. (3.105), the Euler parameter rates are 
simply 


— Be 

sod Q] B 1 Q 

B= 5[BOlw- >| a | = 5lBOle - 5918) (4.146) 
hr 


Note that the vector g() is perpendicular to 3. This makes intuitively sense 
since all valid Euler parameters sets must lie on the four-dimensional unit hy- 
persphere surface. Finding the MRP rates with the orbital motion included is 
greatly simplified using the identity 


[B(o)|[BO(a)] = [B(o)]* (4.147) 
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where the matrix [B(o)] is defined in Eq. (3.150) and [BO(o)] is the direction 
cosine matrix relating the orbit frame O to the body frame 6 in terms of the 
MRP vector o. This relationship is developed in Appendix D. The desired 
MRP rates are then given by 


2 (0102 + 03) 
[B(o)]w — — | 208 + 1-0? (4.148) 
2 (0203 — 01) 


2 Ad. 
o=- 
4 
Linearizing Eq. (4.144) about zero yaw, pitch and roll angles while consid- 
ering 2 to be large we find 
"(d+ Qup 
Ww 6+ (4.149) 
y — 26 
The angular acceleration vector w is then given by 
(6 +.90 
we 0 (4.150) 
y— 26 
since Q is zero for a circular orbit. Before we can write out the linearized 
equations of motion, the gravity gradient torque vector Lg in Eq. (4.134) still 


needs to be linearized. The center of mass position vector R, is given in O 
frame components as 


PR. = | 0 (4.151) 
Re 


After using Eq. (4.143) to map R, into B frame components, the position vector 
is written as 


nis */ — sin 
R.. | = | singcosé@ | R. (4.152) 
Res cos @cos 6 


Substituting these R,, into Eq. (4.134), the gravity gradient torque Dg is ex- 
pressed in terms of the (3 — 2 — 1) Euler angels as 


3 (133 = In2) cos? ésin 20 
2he — 5 _ (Tia = Iz3) cos dsin 20 (4.153) 
— (I22 = T1) sin gsin 20 


Note that the gravity torque vector Lg does not explicitly depend on the yaw 
angle w. Linearizing Eq. (4.153) yields 


(133 — In2) d 
Bh ag w 30? | — (I — Ig3) 0 (4.154) 
0 
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It is interesting to note that the linearized Dg does have any torque components 
about the third body axis bs. Further, for the pitch and roll components of Le 
to be stabilizing, we find that Ig2 > Is3 and Ig2 > 1 must be true. Therefore 
Ia2 must be the largest principal inertia of the spacecraft for these small gravity 
gradient torque induced oscillations to be stable. After substituting Eqs. (4.149), 
(4.150) and (4.154) into (4.33), the equations of motion about each body axis 
are expressed as 


tis (6 +9) =~ (Iss — fz) (6 +9) (b — 96) +30? (Ig — Ira) (4.155) 
b= (0 s 26) (6 + Ow) — 302? (141 — Isa) 6 (4.156) 
Is (v - 26) = — (Ino — I) (6 Fr Ow) (4 if 2) (4.157) 


After neglecting the higher order terms, the linearized spacecraft equations of 
motion can be decoupled into the pitch and roll / yaw modes. The linearized 
pitch equation is 


6 +30? (2) 0=0 (4.158) 
22 


which is the dynamical equivalent of a simple spring-mass system. It is imme- 
diately clear from linear control theory that for the pitch mode to be stable 


Tui = Isa (4.159) 


must be true. The coupled roll-yaw equations of motion are written as 


() + ieee r Q(1 : | @ s eae ae (:) cig Tessie 


where the inertia ratios kr and ky are defined as 


Ing — I 
kp = 2 (4.161) 
133 
Ing — I: 
ky = 8 (4.162) 
Tn 
To determine stability conditions of the roll-yaw motion, the roots A; of the 
characteristic equation of Eq. (4.160) must be investigated. The characteristic 


equation of Eq. (4.160) is given by 


N4402ky O(1— by)] _ 
OT) > 2 Oe |? ees) 


which can be expanded to 


d* + N70? (1+ 3ky + kykr) + 40*ky kr = 0 (4.164) 
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Figure 4.12: Linearized Gravity Gradient Spacecraft Stability Regions 


The roll-yaw equations of motion in Eq. (4.160) are stable if none of the roots \; 
have any positive real parts. Note that the characteristic equations is quadratic 
in \? and can be solved using the quadratic solution formula. No root A? can 
be positive since the corresponding set \;, = +./A? and \;, = —/? would 
contain a real, positive root. To guarantee that all A? terms are negative and 
real, it is necessary and sufficient that 


1+3ke+kyke > 4Vkyke (4.165) 
krky >0 (4.166) 


These two stability conditions have to be satisfied along with the pitch motion 
stability condition in Eq. (4.159). This condition is expressed in terms of the 
inertia ratios kp and ky as 


ky < kr (4.167) 


All three stability conditions are shown in Figure 4.12. The unstable regions 
are shaded while the stable regions I and II are white. 

Since all four roots of the characteristic equation in Eq. (4.164) are imagi- 
nary, only neutral stability of the linearized system is guaranteed. The actual 
nonlinear system may or may not be stable. It turns out the triangular region 
I represents the truly stable region, while the small white region IT in the third 
quadrant is unstable if damping effects are included.! To prove this rigorously 
the dynamics of the center manifold would have to be studied which is beyond 
the scope of this book. The stability conditions in Eqs. (4.166) and (4.167) for 
region I can be written directly in terms of the principal spacecraft inertias J;; 
as 


Ino > tii = Iss (4.168) 
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Therefore, for the spacecraft attitude assumed at the beginning of this section 
to be stable in the presence of gravity gradient torques, the pitch axis inertia 
must be largest and the yaw axis inertia the smallest. If the spacecraft is aligned 
with the O frame, then its only angular velocity is wojy = Q62 = Qb:. As 
was shown in Eq. (4.64), having a pure spin about the largest moment of inertia 
corresponds to a minimum kinetic energy condition. The neutrally stable region 
II would correspond to having Ig2 be less than [;; and J33. This indicates that 
the spacecraft is nominally rotating about the axis of least inertia which is a 
mazimum kinetic energy state. As is shown in Figure 4.7, in the presence of 
damping this spin will degrade in the presence of damping to a pure spin about 
the axis of maximum inertia (i.e. minimum kinetic energy state). Gravity 
gradient satellites are therefore typically long and skinny structures flying in an 
“upright” attitude relative to the local horizon. 


Problems 


4.1 Starting with Eq. (4.9) and using Eqs. (4.10) through (4.12), verify Eq. (4.13). 


4.2 Find the moment of inertia matrix of a box with side lengths 2a, 2b and 2c. The 
cube material has a unit density. The cube center is at the cartesian coordinate 
system origin and all its sides are aligned perpendicular to coordinate axes. 


4.3 Let the unit axis of the rigid body coordinate frame B : {b1, bo, bs} be given in 
terms of inertial frame VV components as 


. 0 : 1 
bh =] 1 bo = | 0 bs = | 0 
1 0 


The inertia matrix in terms of B frame components is given by 


15 0 0 
Sm=]0 1 5 
0 5 16 


a) Find the rotation matrix [C] that will map the B frame into a new frame 
F such that 7[I] is diagonal. 


b) What are the principal inertias of this rigid body. 


c) What are the principal body axis expressed in NV frame components. 
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4.4 A rigid body at an orientation of w = 5, @ = 10 and ¢ = —3 has a total 
mass M = 100 kg and an inertia matrix 


34 1 6 
W=]1 15 3] kgm? 
6 3 10 


The center of mass is moving at 5m/s and the (3-2-1) Euler angle yaw, pitch 
and roll rates are 7) = —1™/s, 6 = 1% /s and ¢ = 4"'/s. Find the total kinetic 
energy of this rigid body. 


4.5 A solid disk with mass m and radius r is rolling under the influence of a constant 
gravity field inside a cylinder of radius L as shown in Figure 4.13. 
a) Find the angular momentum vector Ho relative to the cylinder center O. 
b) Find the equations of motion of the disk. 
c) What is the natural frequency of the motion assuming that 6 is small? 
d) Given an initial angular position 0(0) and rate 6(0), find the angular ve- 
locity 6 when @ = 0°. 


Figure 4.13: Solid Disk Rolling inside a Cylinder 


4.6 A slender rod of length LZ and mass m is standing vertically on a smooth, level 
surface. After it is slightly disturbed, the rod will fall on the ground. 


a) Find the differential equations of motion of the rod where the angle 0 
defines the orientation of the rod. 


b) Find a relationship between the angular rate 6 and the orientation angle 
0. 


4.7 A slender rod of length L and mass m is standing vertically on a rough, level 
surface with a friction coefficient w. After it is slightly disturbed, the rod will start 
to rotate towards the ground. Find a relationship between the friction coefficient 
p and the rod orientation angle 0 where the rod starts to slip. 


4.8 A rigid link of mass M and length L is attached to the ceiling as shown in Fig- 
ure 4.14. A mass m is attached to the lower end of the link. Find the differential 
equations of motion of this pendulum system and its natural frequency. 
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Figure 4.14: Rigid Link Pendulum with Mass Attached at End 


4.9 The principal inertias of a rigid satellite are given by 
I, =210kgm?) Ip = 200kgm? Iz = 118kgm? 


At time to the body angular velocity vector is w = (0.2,0.15, —0.18)" rad/s. 
Numerically solve the resulting torque-free motion for 30 seconds and plot the 
resulting attitude in terms of the (3-2-1) Euler angles. 


4.10 A solid cylinder of mass m, radius a, and length [| is pivoted about a transverse 
axis (B-B’) through its center of mass as shown in Figure 4.15. The axis (A-A’) 
rotates with a constant angular velocity 2. Assume 1 > 3a. 

a) Find the frequency wr, of small oscillations about 0 = a 


T 


b) What is the angular velocity 6* when 0 = 5, if the cylinder is released 


from 6 = 0 with a very small positive value of 69? Determine 6* as a 
function of m, a, l and Q. 





Figure 4.15: Solid Cylinder in a Two Hinge Gyroscope 


4.11 & Consider the free rotational motion of an axially symmetric rigid body with I, = 
2It, where J, is the axially moment of inertia and J; is the transverse moment 
of inertia. 


a) What is the largest possible value of the angle between w and H? Hint: 
Consider the angular momentum vector H fixed and vary the kinetic 
energy T’. 


b) Find the critical value of kinetic energy which results in the largest angle 
between w and H. 
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4.12 &A vertical shaft is driving two grinding wheels by rotating at a constant angular 


rate 2 as shown in Figure 4.16. Each grinding wheel and its support shaft have a 
mass m with the center of mass point located a distance L away from the hinge 
point. Their inertia about their axis of symmetry is J, and the transverse inertia 
is It. Due to the level of the floor, the support shafts are raised by an able a. 
Assume the grinding wheels are rolling without slip. 


a) Find the total angular momentum vector of the system about the hinge 
point O. 


b) For a given fixed 2, how strongly does each grinding wheel push against 
the wall? 





Figure 4.16: Two Grinder Wheels Rolling Rolling about a Driving Shaft 


4.13 @& An axially symmetric space vehicle with I;/I, = 10 is undergoing a general 


4.14 


4.15 


torque-free motion. The angle between the angular momentum vector H and 
the axis of symmetry is 45". At some instant during the motion, symmetrically 
placed masses are moved slowly toward the axis of symmetry by internal forces. 
At the end of this process, the rotational kinetic energy is found to be three times 
its former value, whereas J, is halved and J; is 80 percent of its original size. 
Determine the final angle between H and the symmetry axis. 


A vertical shaft is rotating at a constant angular rate Q. At its lower end it 
has a shaft attached to it through a pin connection. A disk is connected to this 
shaft and is free to spin about the shaft axis. The moment of inertia of the 
disk/shaft system is J; and the transverse inertia is I:. The center of mass of the 
disk/shaft system is located a distance L away from the hinge point as shown in 
Figure 4.17. What is the necessary angular velocity vector of the disk relative to 
the shaft that will maintain a constant angle a? 


Verify the gravity gradient stability conditions in Eqs. (4.165) through (4.167). 
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CHAPTER FIVE 


Generalized Methods of 
Analytical Dynamics 





During the mid-19th century, a family of fundamental developments were in- 
troduced, led by Lagrange, Hamilton, and Jacobi. These results provided a 
unifying perspective on analytical mechanics and also stimulated fundamental 
advances in allied mathematical sub-fields such as variational calculus, differen- 
tial equations, and topology. The most central developments are embodied in 
elegant and powerful methods for deriving differential equations of motion by 
taking gradients of scalar functions they introduced (e.g. the Lagrangian and the 
Hamiltonian, closely related to the mechanical kinetic and potential energies of 
the system), relationships of mechanical system motion to variational principles 
(e.g. D’Alembert’s Principle and Hamilton’s Principle), and efficient methods 
for accommodating constraints and constraint forces. Collectively, these insights 
amounted to a revolution in analysis of dynamical systems, even given that their 
starting point was the summation of the monumental works of Newton, Gauss 
and Euler. This chapter and the following one provides the most fundamen- 
tal aspects of these classical developments; we start with Newtonian/Eulerian 
principles and utilize a system of particles as a conceptual representation for a 
large class of systems. We introduce virtual and related variational arguments 
leading to D’Alembert’s Principle, Lagrange’s Equations, and Hamilton’s Prin- 
ciple. Finally, we generalize these particle mechanics results to establish the 
corresponding developments applicable to systems idealized as collections of 
particles, rigid bodies, and distributed parameter systems. Examples are uti- 
lized throughout this discussion to illustrate the ideas and provide some insights 
into their utility. 


5.1 Generalized Coordinates 


Consider the familiar problem of a particle moving relative to an inertially 
fixed Cartesian coordinate frame. With reference to Fig. 5.1, we introduce 


159 


160 GENERALIZED METHODS OF ANALYTICAL DYNAMICS CHAPTER 5 





Figure 5.1: Generalized Coordinates of Point P 


three classical coordinate choices to locate point P relative to Point O, viz.: 
Cartesian Coordinates (x, y, z), Spherical Coordinates (r,¢, 6), and Cylindrical 
Coordinates(d, ¢, z), with the following three corresponding vector representa- 
tions of the inertial position, velocity and acceleration: 

Cartesian Coordinates and {f1, f2, 3} vector components: 


= tN O+ yn2 Es zns 


= thy, tyr. tins (5.1) 








r= rn, a yny ae zn3 
Spherical Coordinates and {é,, €y, €9} vector components: 


r=ré, 

r= ré, + rb€g + rd cos bE4 

# = (# — r0? — rd? cos? 0)é,. (5.2) 
+ (récos 0 + 2% cos 6 — 2rb0 cos Deg 

+ (r6 + 276 + r¢? sin 6 cos 0) Eg 





Cylindrical Coordinates and {ég, €y, 3} vector components: 
r= dégt+ zh3 
r = dég + dbéy + tig (5.3) 
# = dég + (db + 2d¢ — dé” )ég + Zig 





From inspection of the geometry in Fig. 5.1, we can readily establish the 
corresponding family of six coordinate transformations: 
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Transformations to Cartesian Coordinates: 


u(r, é,0) = rcos@cos ¢, x(d, ¢,z) = dcos¢ (5.4a) 
y(r, 6,0) = rcosOsin ¢, y(d, d, z) = dsing (5.4b) 
z(r,@,0) =rsin8, 2(d,¢,z) =z (5.4c) 


Spherical Transformations: 
r(x,y,2) = fa? + y? + 22, r(d, @,z) = Vd? + 2? (5.5a) 
O(a, y, 2) = tan~'(y/a), $(d, 4,2) = (5.5b) 
O(a, y,z) =sin7'(z//a2 + y2 +22), O(d,¢,z) =sin7*(z/Vd? + 22) (5.5c) 


Cylindrical Transformations: 


U(x,y,2) = Va? +y?, d(r,@,0) = rcosé (5.6a) 
(x,y,z) = tan" (y/z), o(r, 6,0) = ¢ (5.6b) 
2(X,Y, Zz) = 2, 2(r,@,0) =rsind (5.6c) 


Thus, even in this simple and most familiar example, we see that that an 
infinity of coordinate choices are possible. Depending upon the objectives being 
pursued in any given problem, any of these coordinate choices may be appropri- 
ate. It is clear that the details of most traditional analyses, such as formulating 
the differential equations of motion, are affected by the coordinates selected, 
since expressions for all kinematical and physical quantities depend on the co- 
ordinate choice. You can verify that the kinetic energy T = mr - 7/2, for the 
three above coordinate choices has the following three corresponding functional 
forms: 


T(x, y, 2,2, 9,2) = m(#? + y? + 27)/2 
T(r, ¢, 9,7, 6,0) = m(#? +776? + 774? cos? 6) /2 (5.7) 
T(d, ¢, 2, d, 6, 4) = m(d? + d*d? + 27)/2 





Lagrange, in thinking about the above and analogous issues, was apparently 
the first to ask the question: “Can one develop a universal form of the differential 
equations of motion, as a function of the system kinetic energy and unspecified 
generalized coordinates, i.e., T(q1, G2, ---; Gn; G1 92) +) @n), that holds for all infin- 
ity of possible coordinate choices, and for particle motions, rigid body motions, 
translations, rotations, deformational vibrations... ?” The answer to this open 
ended, multi-faceted question is a qualified yes. The immortal developments 
that follow were introduced, mainly by Lagrange, in his quest to address these 
and related issues. In the process of re-tracing some of the work of Lagrange et 
al, we will find important branch points to concepts that go far beyond the scope 
of the above question. At the heart of these developments, it is evident that the 
various vector descriptions for position (r), velocity (7), and acceleration (7) , 


162 GENERALIZED METHODS OF ANALYTICAL DYNAMICS CHAPTER 5 


e.g., Eqs. (5.1) — (5.3), are alternative descriptions of mathematical representa- 
tions of the same physical quantities, and of course, the corresponding forms of 
kinetic energy, e.g., Eq. (5.7), are likewise alternate mathematical representa- 
tions for the same physical quantity. Thus the most important key to obtaining 
generalized (universal) forms for the equations of motion, for example, from 
variation of a generic function for kinetic energy T'(q1, qa, ---; dns V1; 92; + Qn); i8 
to consider from the onset a broad class of systems (for both “body models” and 
forces) and a brad class of admissible coordinate choices. While broad general- 
ity necessarily introduces a level of abstraction in the formulation, the ensuing 
analysis is of bearable complexity and well justified by the powerful generalized 
results obtained therefrom. 


5.2 D’Alembert’s Principle 


Here we derive from Newton’s second law an alternative formalism for devel- 
oping equations of motion, this formalism will be seen to have an advantage 
that certain virtually non-working forces can be ignored. The most important 
role of D’Alembert’s Principle, however, is that it is a stepping stone leading to 
Lagrange’s Equations, Hamilton’s Principle, and other variational principles in 
analytical dynamics. 





Figure 5.2: A System of N Particles 
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5.2.1 Virtual Displacements and Virtual Work 


We consider a system of N particles, with the ith particle having mass mj. 
With reference to Fig. 5.2, we locate m; with an inertial position vector R;. We 
consider the total force vector acting on m; to be segregated into two summed 
sub-sets of forces as 


Fo=fa+hi (5.8) 


where f,, is the vector sum of all virtually non-working constraint forces forces 
(as explained below) acting on m;, and f; = F; — f<, is the vector sum of all 
other forces acting on m;. We will see that the constraint forces (f.,) can be 
eliminated from the analysis and this is an advantageous feature common to all 
of the methods of generalized mechanics. In order to accomplish the elimina- 
tion of the constraint forces, we introduce the concept of virtual displacement 
OR;. A virtual displacement, in the most general context, is an instantaneous 
differential displacement for the sake of analysis. The virtual displacement 6(-) 
of a dynamical motion variable (-) is closely related to the first variation of 
coordinates in variational calculus. We discuss subtle differences between vir- 
tual displacements and first variations in the developments of this chapter and 
especially in chapter 6. In dynamics problems where constraints are present, 
the most frequently used subset of virtual displacements dR; are consistent 
virtual displacements which locate differentially displaced neighboring positions 
R,+6R,; for m; that satisfy the constraint equations. In general, these virtual 
displacements are otherwise independently variable at each instant of time, and 
do not necessarily locate a family of points on a smooth neighboring trajectory 
(although this is an important special case). If the constraints acting on the 
system are smooth differential functions of R;(t, qi, q2,---;@n), then admissible 
R; are constrained to lie on a smooth holonomic (function of position coordi- 
nates only) constraint surface w(t, q1, q2,---;@n), and we see that admissible or 
consistent virtual displacements 6R; locate points in a tangent plane, whose 
normal can be obtained by taking the gradient Vw of the constraint surface. 
This idea is illustrated in general by Fig. 5.3. Note that the differential displace- 
ment dR; = R;(t)dt is tangent to a particular trajectory, whereas the consistent 
virtual displacement 6R; is an arbitrary differential displacement to any neigh- 
boring point in the tangent plane of feasible displacements. Thus the virtual 
displacements are not necessarily tangent to any solution trajectory, but they 
are required to locate neighboring differentially displaced points satisfying the 
constraints, at some arbitrary and unspecified time ¢ in the motion. Ignoring 
friction, the constraint force f., is always normal to the constraint surface (i.e., 
in the direction of Vw), and therefore can be written as 


where the scalar is a Lagrange multiplier. Friction and all forces (other than 
Eq. (5.9)) are accounted for in f; of Eq. (5.8) 

The Virtual Work 6W is an abstract idea analogous to mechanical work, 
but associated with the instantaneous virtual displacements. The virtual work 
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Tangent Plane whose hVy 
normal is Vy, this 

plane contains the set 
of all admissible dR;. 








Typical 
dynamical 
trajectory 


Figure 5.3: Particle Moving on a Holonomic Constraint Surface 


done on m; as a consequence of virtual displacement 6R; is defined as 
OW; = F;- 6R; (5.10) 


Observe that the constraint force f., = AVw is normal to the plane containing 
all infinity of admissible virtual displacements 6R;, and this can be stated as 
the orthogonality condition: 


dWe, = fo, -OR; =0 (5.11) 


Thus the virtual work done by the normal constraint force associated with holo- 
nomic constraints is zero. Note, substituting Eq. (5.8), and making use of 
Eq. (5.9), we find that the virtual work on m, reduces to 


OW; = fi - OR; (5.12) 
We define the total virtual work to be the sum of the d6W;, so that 


N N 
bW=S°F,-6R = 50 fi - OR: (5.13) 


i=l i=1 


5.2.2 Classical Developments of D’Alembert’s Principle 


From Newton’s second law for the motion of m;, we know F; = miRi, so using 
Eq. (5.8), we can write 


Fe; + f,—m;R; = 0, for i= DD (5.14) 


Upon taking the dot product of Eq. (5.14) with an arbitrary virtual displace- 
ment dR; and summing over all N particles, we find the most general form of 
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D’Alembert’s Principle to be 
6W — Somat ;- 6R; =0 (5.15) 


We can put Eq. (5.15) in a more convenient form by recognizing that R; = 
Ri(t,q, Q2;--;9n), so that we can consider dR; to be generated by a set of 
independent virtual variations in the q;s through 





“ OR 
oR; = l 
De 5 (5.16) 
j=l 
As a consequence, the virtual work can be written from Eq. (5.13) as 
= S35 O56; (5.17) 
j=l 


where the n generalized forces Qj are defined as a function of the N virtually 
working forces fi as 


N.. OR; 
= eet 5.18 
Q; pe f OG; (5.18) 


Using Eqs. (5.16)—(5.18), D’Alembert’s Principle of Eq. (5.15) is brought to the 


form 


sla Somat i> | dq; =0 (5.19) 


j=l 


Now, since the dq; are independent virtual variations, they may be chosen inde- 
pendently and arbitrarily, so that the only conclusion possible from Eq. (5.19) 
is that each [-] term must independently vanish. This gives the most famous 
form of D’Alembert’s Principle as 


N 
So mR; - OTE va Q; forj=1,2,...,n (5.20) 
i=1 04) 


These equations are generally a coupled system of n second order differential 
equations, as will be illustrated by several examples below. First we consider a 
modification of Eq. (5.20) which facilitates derivation of the generalized forces 
and also makes connections with the notations of Kane, Moon, et al. 

Observe that the position vector Ry, = Rz(t,q1,q2,--- Qn) can be differen- 
tiated, using the chain rule, to obtain the expression for velocity 


Vi-R- e+ a —“%, i=1,2,..,N (5.21) 
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From this equation, we can immediately see the following important identity 
(known as the “cancellation of dots identity” ) 


OV, _ OR, _ OR, 


Sa FE Cj 5.22 
OGe = On = Oa me (22) 





Note that the time derivatives of the generalized coordinates (q,) always 
appear linearly in the inertial velocities V;. The quantities v;, of Eq. (5.22) are 
simply the vector coefficients of gx, so Eq. (5.21) can be re-written as 


OR te 
Vin Bim “op + 2 demi i=1,2,...,N (5.23) 


The vectors v;, are obviously important kinematic quantities, they have been 
given various names such as “partial velocities” (Kane et al)! and “tangent 
vectors” (Lesser, Moon, et al)?»? . We adopt Kane’s partial velocity label, 
oe Whatever we 
choose to call them, the n vectors {vj1, Vi2,... , Vin} form a vector basis for the 
inertial velocity V; of the ith mass m;, and for the case that time does not appear 
explicitly, the q, are the coefficients that linearly combine the basis vectors viz 
to give the velocity vector V;. The general case is given by Eq. (5.23). 

As a consequence of the truth that the inertial velocities must be formed en 
route to determining the inertial accelerations, we can simply record the vectors 
viz as they are generated in deriving the velocity-level kinematic description of 
the system. We can now re-write D’Alembert’s Principle of Eq. (5.20) and the 
generalized force of Eq. (5.18) as 


because partial velocity is descriptive of the definition vj, = 





N 
So mR; ‘Viz =Q; for j = 1,2,...,n (5.24) 
1=1 
and 
N 
i=l 


or, we can combine Egs. (5.18) and (5.25) write D’Alembert’s Principle in the 
form? 


N 
Slfi-— mVi] vy =0 forj =1,2,...,n (5.26) 


wl 


The above developments can be illustrated by the following example. 
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Two Degree of Freedom System Free Body Diagram 





Figure 5.4: Classical Cart - Pendulum System 


Example 5.1: 


With reference to Fig. 5.4, we develop this system’s equations of motion using 
(i) Newton's Laws and (ii) then D’Alembert’s Principle. First we set down 
the kinematic equations as follows: 


Kinematics of m1: 
Ri=21m, Ri=V=ém, Ri=V=aim (5.27) 
Kinematics of m2: 
Ro =2n, + ré, = (w+ rsind)n1 + (—rcosé)nre 
Ro = V2 = ¢f1 + rbé9 = (4 + r6.cos 0) fy + (rOsin 0) Ae 
Ry = V2 = #f — r67é, + rE, (5.28) 
= (4—r6 sind +r cos 0) fi + (76? cos 0 + rO sin 0) fe 
= (Zsin 0 — r6”)é, + (#cosO + rO)ép 


Differential Equations Derived via Newton’s Laws: 
Making use of Newton's second law, we have the vector equations of motion 


mR; = miV: = F; (5.29) 


Referring to the free body diagram on the right hand side of Fig. 5.4, and 
making use of Eqs. (5.27) and (5.28) to obtain 


mie = —kx + F,sin@ 


(5.30) 
0= N—-—muig — F,cosé 
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and for the m2 equations, taking components of Eqs. (5.29) in the {e,, eo} 
basis 


mo(#sin@ — r6?) = —F, +m gcos@ 
2 ) : (5.31) 
m2(#cos 6 + r@) = —mgg sind 


Solving the first of Eqs. (5.31) for the constraint force (pendulum tension) 
F,, we obtain 


F,, = m2g cos 0 — ma(4 sin é — r6”) (5.32) 


Which, substituting into the first of Eqs. (5.30) and the second of Eqs. (5.31) 
eliminates the constraint force F; and leads to the pair of differential equations 
that govern the system dynamics: 


mi+me sin? 0 Z — mor 6? sin? = —kx + megsin @ cosé 
a (5.33) 
(mz cos 0)% + (mar) = —maqg sin 0 


Differential Equations Derived via D’Alembert’s Principle: 

We will make use of Eqs. (5.12) - (5.20) to derive the equations of motion via 
a path that does not require us to first introduce the constraint forces (N, F-), 
then eliminate them. For the initial developments we will also not make use of 
the partial velocity ideas, but rather directly differentiate the position vectors 
to obtain the terms needed in the classical D’Alembert's Principle equations 
of motion. We see that the gradient of the inertial position vectors with 
respect to (x,0) is needed, the needed partial derivatives can be obtained 
directly from R;(x,0) as 


OR, OR, 




















oh =n OR i GOH a = r(cos O71 + sin O72) . 
Ga a Bee ae ? : 
Using these, we obtain the generalized forces from Eqs. (5.18) as 
~ OR, OR, 
ae Ox eee Ox 
= [(—ka) ma] - [i] + [-mgna] - [Ai] 
Soe (5.35) 
Ora ee Spe OMe 
00 00 


= [(—kx) ni] - [0] + [mg cos 0é, — mg sin 0é6] - [réo] 


= —mgr sind 


We are now prepared to develop the differential equations of motion using 
D'Alembert's Principle in the form of Eqs. (5.20) as follows: 


OR, - OR2 
Ox | maka - Ox 
OR, -~ OR2 
Og ee ae 


mR, - 








= Qe 
(5.36) 





mR - 


=Qo 
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Substitution of Eqs. (5.35) and (5.34) leads to the system of differential 
equations: 


(m, + m2) + (mer cos 0)6 — mor? sin 6 = —ka 
ae (5.37) 
(mer cos 0)% + (mer*)6 = —mgr sin 6 


The above developments could be accelerated modestly by making use of 
the so called virtual power? form of D’Alembert’s Principle (Eqs. (5.26)), 
and by collecting the partial velocities v4; from the velocity level kinematics. 
Adopting the notation qi = x, q2 = 6, then Eqs. (5.26) specializes to 





(fi — mVi] -vi1 + [fo — m2Vi] -v21 =0 (5.38) 
[f1 — miV2]- vie + [fe — m2Vi] - v22 = 0 
where from the velocity-level kinematics we see 
Vi=Ri=im, - vu =m, vi2=0 (5.39) 


V2 = Ro =a11+70€o, > v21 = Ti, V2 = THEs 


Direct substitution of Eqs. (5.39) into Eqs. (5.38), along with fi = —kany 
and f2 = —mgvfi2, immediately verifies Eqs. (5.37). For many degree of 
freedom systems, the systematic notation of the virtual power formulation 
offers some advantages. The most important advantage is to recognize that 
one does not need to return to the position vector to take the position partial 
derivatives in the classical version (5.20), these can be simply replaced by 
the partial velocities, by virtue of Eqs. (5.22) which are already available 
as a consequence of having derived the velocity expressions in the form of 
Eqs. (5.23) en route to the also required acceleration vectors. 


Discussion: 


Comparing Eqs. (5.37) to those (Eqs. (5.33)) obtained from Newton's second 
law, we see that these equations have different forms. The more elegant 
form of Eqs. (5.37) is preferred due to the symmetry of the acceleration 
coefficients (the elements of the “mass matrix”). Both sets of equations are 
correct and it is easy to re-arrange Eqs. (5.33) via linear combinations of 
the two equations to obtain the form of Eqs. (5.37); this development is left 
as an exercise. An implicit question arises: How can we guarantee that we 
obtain the symmetric form of Eqs. (5.37) directly from Newton's laws? The 
answer can be verified, for this special case, by re-working the Newton's law 
developments and insisting that all acceleration and force vectors be projected 
such that all acceleration and force vector components are taken in a common 
reference frame [i.e., use either (é,, €9) or (71, 2) unit vectors exclusively, 
rather than the mixed pattern used to obtain Eqs. (5.33)] before writing the 
two sets of component equations from Newton's second law. More insight on 
this issue can be obtained from the subsequent developments of this chapter. 
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5.2.3, Holonomic Constraints 


The above developments implicitly assume that the generalized coordinates are 
independent. It often occurs that the coordinates are not independent. In the 
simplest case, the redundancy of the coordinates arise because of constraining 
algebraic relationships of the form 


Pelt, Qi, 425.00 9dn) = 0 k=1,2,...,m (5.40) 


We note that any velocity-dependent constraint that cannot be integrated to 
obtain the above form would not qualify as holonomic, and obviously, all inequal- 
ity constraints must be considered non-holonomic. If time does not explicitly 
appear, then this special case of holonomic constraints are said to be rheonomic. 
For most cases, we restrict attention to the case that the w,(t, q1,q2,--- ;Qn) are 
continuous and differentiable with respect to all arguments. 

Consider briefly the special case of m = 1, then (qi, q2,--- ;@n) = 0 con- 
stitutes a constraint surface on which the admissible trajectories lie, and as a 
consequence, the coordinates {q1,q2,--- ,@n} are not independent. There are 
two obvious approaches to dealing with the constraint: (i) Solve the constraint 
equation for any one of the coordinates as a function of the other n—1 q’s which 
may now be considered independent, or (ii) Replace the constraint surface by 
an equivalent constraint force that effectively causes the motion to remain on 
the constraint surface. These two approaches are illustrated by the following 
example. 


Example 5.2: Let us study the simple pendulum shown in Fig. 5.5. Consider 





Figure 5.5: Classical Pendulum 


the redundant coordinates (r,@). The position, velocity, and acceleration 
vectors are given by 


R=ré,, R=7é,+r6és, R=(i—r6’)é,+(r6+4+27r6)é9 (5.41) 
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We consider two approaches for imposing the holonomic (and rheonomic) 
constraint r = R = constant, or 


v(r,0) =r—-R=0 (5.42) 


Algebraic Constraint Elimination 

In this approach, the constraint equation of Eq. (5.42) is trivially solvable for 
r = R, and the derived constraint conditions that * = 0,7 = 0 are imposed 
on the kinematics equations of Eq. (5.41) to obtain 


R=Ré,, R= R0é, R = (R6)é, + (RO)Eg (5.43) 


leaving only @ as an independent coordinate. We can now apply D’Alembert’s 
Principle of Eq. (5.20) to generate the differential equations as follows 


mR.- OR = Qe 
ee ; (5.44) 
mR?6 = —mgRsn@ — @= -4 sin 0 


Constraint Force via Lagrange Multipliers 


In this approach, we observe that the pendulum is physically constrained to 
move on a circular constraint surface and the associated force must be normal 
to this surface. While the direction is known, the magnitude is not. Thus the 
constraint force associated with w(r,0) =r — R =0 is written as 


F. = AV) = Ne, (5.45) 


where the unknown scalar A is a Lagrange Multiplier. 


The total force acting on mass m is —mgnz + AE, so that D'Alembert’s 
Principle of Eq. (5.20), considering both r and @ as generalized coordinates 


Is 
ie (5.46) 
06. 


which gives 
m|(# — r6?)é, + (76 + 27-0) p] - (Er) = [—mgfte + AE] - (E-) = mg cos + A 


m{(# — r6?)é, + (76 + 276) €o] - (rég) = [—mgfi2 + AE] - (rég) = —mgr sind 
(5.47) 


Imposing r = constant = R and carrying out the implied algebra, these 
simplify to the final result 


d= —m(gcos 6 + R6”) 
se g. (5.48) 
é6é=—-—= sind 

Re 
So, we see in this example that D’Alembert’s Principle (when used with 
a redundant coordinate description of the motion, and imposing the holo- 
nomic constraint conditions at the end) generates the constrained equations 
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of motion and determines the Lagrange multiplier (which in this case has the 
interpretation of the negative of the constraint force F;) as a function of the 
coordinates and their derivatives. 





Figure 5.6: Particle Moving on a Holonomic Constraint Surface 


The above developments can be viewed from several perspectives and gen- 
eralized for the case of m constraints and n generalized coordinates. Perhaps 
it would be instructive to first consider the case of three rectangular coordi- 
nates (x,y,z) and one constraint, with Newton’s second law used to develop 
the equations of motion. Consider Figure 5.6, Newton’s second law provides 
the equation of motion 


f+fe=mR (5.49) 


where f, is the constraint force normal to the smooth holonomic constraint 
surface 


v(x, y,z,t) =0 (5.50) 


and f is the vector sum of all other forces not normal to the constraint surface. 
Since w(a,y, z,t) = 0 is assumed differentiable, then from Eq. (5.50), we have 
the derived equation 


db ob, Ob, OW, , 


oe? Oy Be (5.51) 


SECTION 5.2 D'ALEMBERT'S PRINCIPLE 173 


The above condition should be viewed as the time derivative of the constraint 
at any/all points along the path (2(t), y(t), z(t), <(#), y(#), 2(t)). Alternatively, 
we can consider the differential of ~ along the path, which also must vanish. 
Ow Ow Ow Ow 
dw = —d. ——dy + —dz+ —dt = 52 
ap Da oy yt a, z+ 5E 0 (5.52) 

Conceptually, notice that the differential change dw along the path is different 
from the virtual change dw: 
_ Ob, We, Ob 


wt Foyt 5752 =0 (5.53) 


oY Ox O Oz 


Note in Eq. (5.53), (dz, dy,6z) are arbitrary admissible virtual displacements 
that locate all infinity of points lying in the local tangent plane whose normal is 
Vw (see Figure 5.3), whereas (dx, dy, dz) are the particular differential displace- 
ments along the path from {x(t), y(t), z(t)} to {a(t + dt), y(t + dt), z(t + dt)}. 
From another perspective, Eq. (5.53) can be viewed as the condition that ad- 
missible virtual displacements must satisfy. If ¢ is not explicitly contained in 
w, then {dx, dy, dz} are obviously a special case of {d2, dy, 6z}. Following the 
same argument leading to Eq. (5.9), we know f, is proportional to Vw 


fe =AVY= s2eR + gk hs + (oem (5.54) 
Ox Oy Oz 


and thus the equations of motion of Eq. (5.14) become 





mt = fet we 
* 0 
my = fyt az (5.55) 
mz= fet oe 
V(x, y,z,t) =0 (5.56) 


We note that Eqs. (5.55) and (5.56) provide three differential equations and one 
algebraic equation — four equations involving four unknowns z(t), y(t), z(t) 
and X(t). 


Example 5.3: We return to the simple pendulum of Figure 5.5 and consider 
the alternative choice of rectangular coordinates (x,y). In lieu of the polar 
coordinate representation of kinematics in Eq. (5.43), we have 


R=2ni+ yne 
R=4ni + yrs (5.57) 


R=#"1 4+ Ynr2 
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From Eq. (5.55) we have three equations with three unknowns x(t), y(t) and 


A(t) as 
mk = (2x) 
cs (5.58) 
my = —my + A(2y) 
e+y?—-L? =0 (5.59) 
We can eliminate \ by taking two time derivatives of Eq. (5.59) as 
Qrdé + 2yij + 2a? + 24? =0 (5.60) 
and solving for (4, ¥) as a function of \ from Eq. (5.58) as 
ra(2) 
m 
(5.61) 


*s 2y 
Y=—-g+A (=) 


Substitution of (4,7) into Eq. (5.60) and making use of r? = x? + y?, we 
have 


we sa [yo — (# +-9°)] (5.62) 


And finally, substitution of Eq. (5.62) into Eq. (5.58), we have 
UH —s [yg — («? +9°)| 
(5.63) 


m < e 
mij = —g+ [yg + (@? + 9°)] 


Notice either of the equations in Eq. (5.63) could be solved, together with 
either «© = +,/r?2 — y? or y = +r? — a@?. These equations are “suffi- 
ciently ugly” that we note the un-surprising truth, comparing Eqs. (5.62) and 
(5.63) with the familiar/elegant Eqs. (5.48), a judicious coordinate choice is 
frequently of vital importance! In this case (1,0) is vastly superior to (2, y), 
because r = R = constant and 6(t) directly describes all feasible motions con- 
sistent with the constraint. We note — for small motions near (r,@) = (R, 0) 
and (x,y) = (0, —R) both reduce to essentially the same linear system 








6=—Fo and/or #=—Ze (5.64) 


and thus we note that coordinate selection is often more forgiving for small 
(linear) motions than for large (nonlinear) motions. 


We now consider the case that two constraints ~; exist: 
Ur(x, y, 2, ¢) = 0 fork = 1,2 (5.65) 


The constraint force f, in Eq. (5.54) is the vector sum of the two constraint 
forces as 


fe = MVU1 + A2V 2 (5.66) 
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and the Newtonian equations of motion become 








. a a 
mé= fet oF + og? 
O O 
mij = fy + Fe + we (5.67) 
; a a 
min fet ht es? 


and we have the two algebraic equations of Eq. (5.65) providing five equations 
in terms of the five unknowns 


{x(t), y(t), 2(t), Ar(t), A2(t) F (5.68) 


Example 5.4: We note that the above developments all hold for a certain 
class of holonomic constraints w(x, y, z,t) = 0, for which 


yp , D, , OW, , OD, 
Vege pg ope oe ee9) 


We will see subsequently that the above developments can be generalized to 
consider a class of non-holonomic constraints 


Bia, y; 2) +A (x,y; Zz) + Aa(a, Yy, z)y ae A3(z,y, zz =0 (5.70) 


Such constraints, which depend on velocity linearly, are known as Pfaffian 
constraints. Notice, if a function ~(a, y, z,t) exists such that 


0 
B(x, y, 2) = “ 
5.71) 
a O 0 ( 
As(2,y,2) = 2, Aa(2, 942) = 5, As(a,y,2) = < 


then Eqs. (5.70) are said to be integrable to the holonomic constraint «)(x, y, z,t) = 
0. Performing partial integration, it is easy to test directly to see if a Pfaffian 

form non-holonomic constraint is integrable to a corresponding holonomic 
constraint. Notice the following example. Suppose a spherical pendulum 
shown in Figure 5.7 is acted upon by a motor torque which exactly enforces 

the motion constraint: 


, _ t(cosd — 4) 
or, we have the Pfaffian form 
(— cos ¢)t + (2+ sin ¢)6 + (t)¢ =0 (5.73) 
Comparing Eqs. (5.70) and (5.73), we have 
B(¢,8) = —(cos 4)t 
Ai(¢,0) =2+sing (5.74) 
A2(,0) =t 
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Figure 5.7: Illustration of Motor Driven Spherical Pendulum 


To see if the non-holonomic constrain of Eq. (5.73) is integrable, we conjec- 
ture the existence of w(¢,@,t) such that 





SE =B=-(csd)t + v=-Z(cosd)i@ + fld0) (6.75) 
SPA =2tsind > P= (Atsing)O+ fold,t) (6.76) 
sie’ + b= ott fa(6,t) (5.77) 


If w exists, there must be a valid choice for the functions of partial inte- 
gration f1(¢,0), fo(,t) and f3(0,t) such that the same function ~(¢, 0, t) 
is obtained from Eqs. (5.75), (5.76) and (5.77). In this case we conjecture 
observing Eqs. (5.76) and (5.77) that 


f2(¢,t) = ot (5.78) 
f3(0,t) = (2sin¢)@ — _ inconsistent, depends on ¢! (5.79) 


Now, comparing Eqs. (5.75) and (5.76), we conjecture 
fil@, 0) = (2+sin 6) (5.80) 
fa(¢, t) = — 5 (cos ¢)t? — — inconsistent with Eq. (5.78) (5.81) 
Finally, comparing Eqs. (5.75) and (5.77), we conjecture 
fild, 0) = ot — inconsitent with Eq. (5.80) (5.82) 
f3(6,t) = —5 (cos o)t? — inconsistent, depends on ¢ (5.83) 


Any of the four inconsistency results obtained for the functions of partial 
integration are sufficient that ~(¢, 0,t) does not exist. Therefore the Pfaffian 
form of Eq. (5.73) is a non-integrable non-holonomic constraint. 
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5.2.4 Newtonian Constrained Dynamics of N Particles 


The above developments are now generalized to N particles subject to m con- 
straints. As the most fundamental choice of coordinates, we could choose the 
inertial Cartesian set of coordinates 

{q} = {n, 92, 93,--- Gn} = (21; Y1, 215 V2, Y2, 225--+ 5 Un, Yn; Zn} (5.84) 


where n = 3N. More generally, {q} is any set of n = 3N generalized coordinates. 
Consider a set of m Pfaffian non-holonomic constraints of the form 


S79 AnjGj + Br=0 k=1,2,...,m (5.85) 
j=l 


or, in differential form 


S 7 Anjdqj + Bedt=0 k=1,2,...,m (5.86) 
j=l 
where Ag; = Agj(Q1,--- ,Qn,t) and By = Bg(q,.-- ,dn, t). Some, and occasion- 


ally all, of the constraints may be integrable to obtain holonomic constraints of 
the form 
OGiget feat) =O PSM Qa 4M (5.87) 


Conversely, given smooth holonomic constraints of the form of Eq. (5.87) can 
always be differentiated to obtain Eqs. (5.85) and (5.86). The reverse is true 
only for integrable constraints (see example 5.4). The equations of motion for 
the N particles, for the case that {q} is the set of m = 3N Cartesian inertial 
coordinates is 


Myaj = f+ fos =a + Do Anpre =F =1,2,...,0 (5.88) 
k=1 
where 
{M,, Mo, M3; Ms, Ms, Mg; sass ;Mn_2, Mn-1, M,} 
= {m1, 71,71; Mz, M2, Mg; tee ;mn,mMy, mn } 

and 

> And; + Be =0 k=1,2,...,m (5.89) 

j=l 
Eqs. (5.85) and (5.88) provide n + m equations in the n + m unknowns 

{gisdaxiss »Oni M1, A2,+ + Amt 


The Eqs. (5.88) and (5.89) constitute a set of Differential-Algebraic Equations 
(DAEs). Prior to developing the analogous constrained dynamics results for 
the generalized methods that follow from D’Alembert’s Principle, we digress to 
consider a version of the Lagrange Multiplier Rule for parameter optimization. 
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5.2.5 Lagrange Multiplier Rule for Constrained Optimization 


Consider the problem of extremizing (maximizing or minimizing) the smooth, 
twice differentiable function 


on, G2,--- In) (5.90) 
subject to satisfying m equality constraints of the form 
Wi (M1, G2,---5dn) =0 j=1,2,...,m<n (5.91) 


where w(q1,q2,--- ;Qn) is continuous and at least once differentiable. 

An important result, due to Lagrange, is that the necessary conditions for 
extremizing Eq. (5.90) subject to Eq. (5.91) are identical to the necessary con- 
ditions for extremizing the augmented function 


B(q1,- +. dni Aty-- Am) = O(G1s dn) + DAG (G,---54n) (5-92) 





j=l 
where {X1,...,Am} are Lagrange multipliers, and, as developed below, the nec- 
essary conditions for extremizing ©® is 

O® 

aes = FED oh (5.93) 

0g; PN 

O® 4 i : 

ae. =0;(h,---,dn) =0 PS 1 25.8 nm (5.94) 

J1Q,A 





Egs. (5.93) and (5.94) provide n + m algebraic equations to be solved for the 
“stationary points” 


e ‘A ae 
G= (Gy. 5dn)” AS (Aa Am) (5.95) 
The existence of stationary points (q,A) that satisfy Eqs. (5.93) and (5.94) is 
not guaranteed; there may be one solution, no solution, or multiple solutions. 
Furthermore, additional analysis is required to discern whether the point (q, A) 
represents a local minimum, maximum, or generalized inflection point. 
Implicit in the concept (and proof) of the Lagrange multiplier rule is the 
idea of locally “constrained differential variations.” For example, suppose we 
wish to minimize a function of three variables 


(2, Y, 2) (5.96) 


subject to one equality constraint 


W(a,y,z) =0 (5.97) 
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For arbitrary virtual displacements (dz, dy,6z), the virtual differential change 
in ¢ is 


Od 
65°! By 


do do 


6o= De 


Sy + 62 (5.98) 


Similarly, at an arbitrary admissible point (2, y, z) that satisfies Eq. (5.97), the 
virtual change of ~ is 
ey Ou we — dy a dz 


+ + 


OPS ae Oy Oz 


(5.99) 


For variations to be admissible, we require dy = 0, because the differential 
variations (62, dy, dz) must be locally consistent with w(a+d6z, y+dy, z+6z) = 0. 
Since, for all the infinity of points that satisfy the constraint w(x, y, z) = 0, to 
minimize ¢(, y, z), we seek the particular stationary point(s) #, §, Z) that satisfy 


wean +3 ae 
2s, Bb 8 


6¢=0= (5.100) 


In the absence of the constraint of Eq. (5.97), we could argue that (dz, dy, 6z) 
are arbitrary. This gives the familiar necessary conditions for an un-constrained 
minimum ge = 0;x2 > y,z. However, (62, dy,6z) cannot be taken arbitrarily, 
due to the condition of Eq. (5.101). Following Lagrange, we can locally eliminate 
any of the three variations (dx, dy, dz) to enforce Eq. (5.101), e 


ze OW Ow 
= -(a] ($ bx + Sou) (5.102) 


Thus, for all aaa of differential variations (dx, dy), 6z from Eq. (5.102) guar- 
antees (so long as ad v 4 (0) that Eq. (5.101) is satisfied — i.e., (dx, dy, dz) lie in 
the tangent plane whose normal to Vw (za, y, z) with w(a, y, z) = 0. Substituting 


Eq. (5.102) into Eq. (5.100) gives 
do Ow 0b _ ow 
6 dy =0 5.103 
5-[2-(B) Bar [8-(B)aJao ow 
Thus we have “differentially eliminated” dz. Since (dz, dy) must be consistent 
with (x,y,z) = 0 and 6v(a, y, z) = 0, then Eq. (5.103) can be interpreted as 
the “constrained variation” of ¢, along the curve of intersection of ¢(a, y, z) with 


(a, y, z) = 0. Since all infinity of arbitrary (dx, dy) can now be admitted (while 
6z from Eq. (5.102) guarantees satisfaction of Eq. (5.101)), we can argue that 


ba + 
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the coefficients of (62, dy) in Eq. (5.103) must vanish as the necessary conditions: 


a ce \ a 
a () OY = Fey) 


7 Ox 
ad oe Ob (5.104) 
2 -(# ap ee) 


w(x, y, Zz) =0= f(x,y, 2) 


The equations in (5.104) provide three algebraic equations containing three un- 
knowns (x,y,z). The stationary points (%, 9,2) that satisfy Eq. (5.104) must 
be further evaluated to confirm which points are local maxima, minima, and/or 
saddle points. Upon evaluating all stationary points, the global minimum can 
be discerned as the smallest of the local minima, assuming at least one local 
minimum stationary point is found. 

The above necessary conditions are not unique, because, instead of differ- 
entially eliminating 6z, we could have chosen to eliminate dx or dy. These 
lead to the two alternate forms of the constrained necessary conditions. For dy 
eliminated with (dx, 6z) arbitrary we find: 


a6 _ (3) Ov _ 4 
Ox ob | Ox 


Oy 
ad (=) Ov ; (5.105) 
Oz oe Oz 

v(z,y,2) =0 


and, for dx eliminated with (dy, 6z) arbitrary, we find: 


a6 _ (BE) a _, 
Oy oe Oy 


ad oe Oy : (5.106) 
a: (8) d= 
V(2,y,2) =0 


Lagrange noticed this lack of uniqueness and “automated” the derivation of all 
possibilities by introducing a free multiplier parameter A, and set 


d¢+ AOU = 
d¢ , , OW d¢ , , OW 06 | OV) . 


As before, it “isn’t fair” to set the three ( ) terms to zero using the argument that 
(6x, dy, 6z) are arbitrary and independent — but since A is arbitrary, we can set 
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any one of the three ( ) terms to zero to determine \ (and thereby eliminate 
one of the three of (dx, dy, 6z)) — since the remaining two of (dx, dy, dz) can be 
chosen arbitrarily, all three ( ) terms must vanish. This argument leads to the 
following four equations as the constrained necessary conditions: 





Od OW 
Br It ae => 0 
OD: OMe 
Oy Oy (5.108) 
Og OW 
yo a 
(x,y,z) =0 


It is easy to verify that all three sets of constrained necessary conditions 
(Eqs. (5.104), (5.105) or (5.106)) are implicit in Eq. (5.108), depending upon 
which equation is used to solve for A and then eliminating in the other equa- 
tions. More generally, the equations in (5.108) provide four equations to deter- 
mine the four unknowns (2, y, z, A). 

Lagrange noticed that the above necessary conditions could be obtained by 
taking the gradient with respect to (x,y, z,) of the augmented function 


® = 9(z,y, 2) + AV(z, y, Z) (5.109) 
The Lagrange multiplier rule is given in Eqs. (5.90), (5.91) and (5.92), and is 


proved by a straight-forward extension of the above developments. 


Example 5.5: Assume we would like to minimize 
o(z,y) =a +y? (5.110) 
subject to 
W(x,y,) = (w—5)? + (y—5)? -1=0 (5.111) 


Geometrically, we seek the point on the circle of Eq. (5.111) that is nearest 
the origin. We form the augmented function 


=e? +y? +A [(e@—5)? + (y—5)?- 1] (5.112) 


Following the Lagrange multiplier rule, the necessary conditions are 





OP _ a s 
Sp = We + 2A(w— 5) =0 (5.113) 
O® 
= 994 2h = 5) = 5.114 
i (5.114) 
OP (ee Ga By a0 (5.115) 
OA 
From Eqs. (5.113) and (5.114), we solve for (a, y) as a function of \ as 
r 
pes, fps es (5.116) 


1+. 1+. 
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Observing Eq. (5.115), we form 
A-1 
rA-1 
oa (SH) 


Substituting Eq. (5.117) into Eq. (5.115) we obtain 


(33) 2 i. (5.118) 


These, in turn, give from Eq. (5.117) the stationary points 


(5.117) 








&» 
II 
ou 
u 
rT 





= 
lI 

or 
UW 
A 


1 
ve (5.119) 
Va 


It is easy to verify from Eq. (5.110), the global constrained minimum is at 
the stationary point 


(2,9) = (> = = 5 =) (5.120) 
and 
b=@ +9 = (sv2-1)" (5.121) 


and similarly (#,9) = (5 + 33,5 + zg), locates the global maximum of 
o = (5V2+1). 


5.3. Lagrangian Dynamics 


As presented above, D’Alembert’s principle offers a fundamental advantage over 
Newton’s second law, in that the internal forces and all other virtually non- 
working constraint forces can be simply ignored in developing the equations of 
motion. On the other hand, the vector kinematic algebraic overhead associated 
with Newton’s second law and D’Alembert’s Principle is essentially identical, 
since both require vector kinematics to be taken through the acceleration level. 
In this section, we develop the first of several classical formulations (Lagrange’s 
Equations) which require only velocity level vector kinematics. For the devel- 
opments so far in this chapter, we use the system of particles model for the 
system; these developments will subsequently be generalized to accommodate 
rigid bodies, systems of rigid bodies, and general collections of particles, rigid 
bodies, and distributed parameter systems. 
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5.3.1 Minimal Coordinate Systems and Unconstrained Motion 


We begin by writing the D’Alembert’s Principle form of the system differential 
equations of motion from Eqs. (5.18), (5.20) as 


a OR 
Des 





N 
Z = 7: . on forj =1,2,...,n 
J jet 04; 


which using cancellation of dots identity of Eqs. (5.22) become 





N . 
= Es ol forj =1,2,...,n (5.122) 
J Ge] 04; 


aS ge. (OR 


Lagrange was apparently the first to recognize that differential equations 
closely related to Eqs. (5.122) could be generated using position and velocity 
coordinate gradients of energy functions. We verify these classical developments, 
beginning with the definition of Kinetic energy for a system of N particles: 


N 
= 5 mkt Rj (5.123) 


We observe that the partial derivatives of T with respect to (q;,q;) are 





oT . OR; or R 
Fe ma Gand Fe = Dom (5.124) 
oe Gj 04; = 
Now consider the following developments: 
ae r) Ease a ~ 5 (F 
Som Ri - R; 
i=1 04; 


OR, © d (OR; 
Sli + fa) . Og; 28S R  () 


J 








I 














e (5.125) 
tS eee mR; - 

» P34, oS Gr 04; 
= s fi: OR; 4 or. 

a" 86; Oa; 


Il 
B 


From the above and Eqs. (5.122), we establish the following elegant result (La- 
grange’s Equations) 


d ( 0T 
==) (Zee Jy: —=Q,, f p= ND 12 
dt ($)- = 0g; i= a q Bae ae Co 
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This is the most fundamental version of Lagrange’s Equations, and these 
equations are amongst the most important results in analytical dynamics. We 
will subsequently seek alternative paths to these equations, via Hamilton’s Prin- 
ciple, for example. Notice from Eqs. (5.126), there results a system of n second 
order differential equations of the form 


Fit... - Oni Ny) ni Us ++ In) = Q;, j=1,2,...,n (5.127) 


that are generated by simply differentiating the system kinetic energy T(t; qj; q;) 
with respect to the chosen set of generalized coordinates (q;,q;, 7 =1,...,7) 
and summing the dot product of the virtually working forces with the partial 


velocities viz = ae While we have have developed these equations in the 


context of a system of particles, we will see that an appropriate definition of 
kinetic energy results in these equations applying to systems of rigid bodies 
and particles. Also of significance, we will find that these apply to some degree 
of approximation, upon introducing appropriate spatial discretization methods 
such as the Ritz method or the finite element method,’ to approximate the 
dynamics of distributed parameter systems such as vibrating flexible structures. 
Also implicit in these equations is the assumption that, if constraints are present, 
they are simple algebraic holonomic constraints which have been kinematically 
eliminated to establish a minimal coordinate description of the system, i.e., 
constraints have been enforced in the kinematic description of the system, so 
the generalized coordinates {q1, q2,--- ;@n} must be independent in Eqs. (5.126). 
We consider three examples to introduce the reader to the process of applying 
Lagrange’s Equations. 





Example 5.6: With reference to Fig. 5.8, the radius is decreasing at a 
constant rate, determine angular velocity as a function of time. The general 
expression for velocity is R=ré,4+r6é. Upon imposing the constraint that 
* = —c = constant, then only 6 remains as a generalized coordinate and 
imposing this kinematic constraint, the velocity is R= —cé, + (To — ct) O€p. 
Thus the kinetic energy has the specific structure: T = 4m[c? +(ro—ct)76"]. 
From Lagrange’s equations in the form 


a 
o(=) — = (Fer): “ = Qo 
we have 
d 2; 
qlm(re — ct)*6] — [0] = [0] 
from which 


M(Tro — ct)°6 = constant = mr20o 


giving the desired result 


pa eee 





To — ct 


Discussion: Observe that the kinetic energy does not depend on @ and Qg = 


0, and a consequence, + (3) = 0 and po = af = constant. Whenever 
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the derivative q; of a coordinate g; appears in 7’, but not the coordinate 
itself, then such coordinates are called cyclic. If the generalized force Q; is 
zero, then the corresponding generalized conjugate momentum p; = Fa; is 
a constant of the motion. When the observation is made that a coordinate 
is cyclic and Q; = 0, then the corresponding generalized momentum can 
immediately be set to a constant, thereby by-passing the formal algebra of 
Lagrange’s equations. In this case, po = mr?6 = constant has the physical 


interpretation of angular momentum conservation. 





Figure 5.8: Particle on Table with Constantly Decreasing Radius 


Example 5.7: Consider two particles sliding on a frictionless horizontal plane 
as shown in Figure 5.9. The particles are connected by a linear spring whose 
un-stretched length is R. The form of the equations of motion depend upon 





Figure 5.9: Two Particles Sliding on a fixed Inertial Plane 


the coordinates chosen, also, judicious coordinates often reveal easier insight 
into the system behavior. In particular, the same system may have cyclic 
coordinates with one coordinate choice, but not for other coordinate choices. 
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To illustrate, consider the two Cartesian coordinate choices: 





set 1 (11, Y1, £2, y2) Inertial Coordinates 
set 2 (Le, Ye, £12, Y12) Mass Center Motion and Relative Motion 
where 
1 
Le = —(mMixzi+merez), m=m1i+me 
7 (5.128) 
Yo = — (mays + may2) 
L1i2 = 2-21, yi2 = Y2- Yi (5.129) 
The spring force has a magnitude k(r — d) where r? = aig + Yio. The 


direction of the force is along the instantaneous line of centers, oriented by 
angle 6. Note cos @ = x12/r, sin@ = yi2/r. Thus Newton's laws lead to the 
equations of motion for set 1 as 


miki = k(r = yo miy1 = k(r a ges 
me t (5.130) 

i 12 é yi2 

M2%2 = —k(r — d) a M22 = —k(r — d)=—— 


with r = \/x75 + y2.. For the special case of d = 0, these simplify to the 
linear system 


os = k(a2- 1), ae ee (5.131) 
M22 = —k(x2— 21), mata = —k(y2 — yx) 


For the set 2 choice of coordinates, use Eqs. (5.128) and (5.129) to verify 
that the general dynamical equations are for the case where d 4 0 





mic = 0, [= ) #12 = —k(r — d)—2 
my, + m2 r 
(5.132) 
A mimea 2 y12 
2c = 0, aaa = —k(r —d)2#2 
mic = 0 (ee) ine (r—d)~ 
For the special case where d = 0, the equations of motion become 
HO, jo) Ps ees 
mi +m 
cots (5.133) 
MiG j=) pei etG 
my, + M2 





With the set 2 coordinate choice, we see in all cases that the mass center 
moves in a straight line, and the relative motion dynamics un-couples from 
the mass center motion. For d = 0, we see that the relative motion in the 
x and y direction also un-couples and becomes simple harmonic motion with 


os mim 
the natural frequency w = ,/k aera 
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You can verify that the same differential equations in Eq. (5.130) and (5.133) 
result if Lagrange’s equations are utilized for coordinate set 1. The kinetic 
energy T is given by 


1 
T = 5 (midi + magi + madd + may) (5.134) 


while the potential energy V is expressed as 
1 
V =V(a1,y1, £2, y2) = ahr —d)? (5.135) 


with r = ,/(v2 — 21)? + (y2 — y1)?. For coordinate set 1, the solution is 
straight forward. However, for coordinate set 2, you will need to express the 
energies as functions of the set 2 coordinates as 


T =T (2c, Ye, £12, Y12) 


5.136 
V =V (ae, Yc, £12, Y12) ( ) 
and for this you need the coordinate transformations: 
Ui = Jil®e, Yc, V12, 7=1,2 
fil Ye, 12 yi2) (5.137) 
Yi = gi(Xe, Ye, 12, Y12) p= 12 


These are obtained by inverting Eqs. (5.128) and (5.129). You will find 
(@c, Ye) do not appear explicitly in T and V. Therefore (a, yc) are cyclic 
and “-. = constant, y. = constant are immediately obvious. These steps are 
left as an exercise. 


5.3.2 Lagrange’s Equations for Conservative Forces 


Recall that the generalized forces can in general be written as Qj = ey fi- 
a and for the case of conservative forces, f; = -#, so the generalized 
J 4 


conservative forces can be written as 





N N 
OR; OV OR; OV. 
C= x fi: nF x aR, DG > OG PH 2 on (5.138) 











We introduce the definition of the Lagrangian function: 


Since V = V(t,q@1,--- ,@n), it follows that oe = Se and se = or -- a then 


for the case that all forces are conservative, then Eqs. (5.127) assume the most 
famous form of Lagrange’s equations 


d (OL OL 
— {|—)-— = f P= 192.23 14 
dt ($=) aq; 0, or Jj oe9 > (5 0) 
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For many elementary conservative systems, the potential and kinetic energy can 
be simply written with a minimum of derivations; for these cases, Eqs. (5.140) 
do not require derivation of any generalized forces and are therefore especially 
attractive. In more general circumstances for which there are both conservative 
and nonconservative forces which do virtual work, then Eqs. (5.140) are replaced 
by the more general form 





d (OL OL f 
dt (=) - oq} = Qnej = > Fnci 7 Se for jJ= it 2, eee gM (5.141) 
where fre; is the nonconservative force acting on m;. Of course, the special 
case of non-conservative forces which act normal to the vector os = oR has 
a 


Qne = 0 and this special class of non-conservative systems’ equations of motion 
are also given by Eq. (5.140). The utility of these forms of Lagrange’s equations 
are illustrated in the following examples. 


Example 5.8: With reference to Fig. 5.10, the linear spring pendulum is con- 





Figure 5.10: Classical Spring Pendulum 


sidered (nominal unstretched spring length (r.), linear spring constant (k)). 
The objective is to use the version of Lagrange’s Eqs. (5.141) to efficiently 
develop the equations of motion. It is evident that the only virtually working 
forces are the spring force and gravity, and that there are two generalized 
coordinates (r,@). The position and velocity vectors are given by 


R=ré,, R=ré,+r6és 
Thus the kinetic energy is 


T = 1m. R= dm(i? +76?) 
2 2 
From inspection of Fig. 5.10,, it is evident that the potential energy function 
is 


V = mgr(1 — cos @) + a —To) 
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so the Lagrangian function is 








L=T-V= smi? + r76) — mgr(1 — cos @) Shr To)" 


mi + k(r — ro) — mré? — mg cos 6 = 0 
mr? + mgr sin 8 + Imrrd = 0 
To appreciate the efficiency of the above path to obtain the equations of 


motion, it is instructive to repeat the solution using Eqs. (5.126), including 
the formulation of generalized forces 


Qr = [-k(r — ro)ér — mgnra] - a =...=—k(r—ro) + mgcosé 
T 
Qe = [-k(r — ro)ér — mghra] - 7 ane —magr sin 6 


arising from the spring force and the gravity force. When conservative forces 

that have easily established potential energy functions are present, then Eqs. (5.141) 
clearly results in significant reductions in the algebra associated with deriva- 

tion of the generalized force functions. Obviously, we can ignore all internal 

and constraint forces, as well as all conservative forces, and consider only 

the nonconservative virtually working forces when determining the general- 

ized force functions. In this case, all virtually working forces are conservative, 

so it is not necessary to formulate any generalized forces (they are implicitly 
accounted for by being included in the potential energy function). 


Example 5.9: With reference to Fig. 5.11, we generalize the earlier example 

















Figure 5.11: Damped Cart - Pendulum System 
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solved using Newton's laws and D’Alembert’s Principle, to include the dashpot 
linear damper with associated damping force (—c471). We note that, among 
the virtually working forces, only the damping force is nonconservative. This 
means that the generalized forces are easily determined as 





oe OO 
Qe = [—cény] . ee Se 
Qe =0 
Ri =Vi =r 


Ry = V2 = th + rbé, 


The kinetic and potential energies are 
i slr +me2)é? + smal” +1776? + 2¢r6 cos 6] 
V= sh? + mg2g(1 — cos 6) 
It is easy to verify that Eqs. (5.141) immediately give 
(my + m2)# + (mor cos 0)6 — m2r6? sin 6 = —kax — cé 
(mar cos 0)% + (mer?)6 = —mgr sin 0 


This process is an elegant alternative to the previous development of the 
equations of motion via Newton’s laws or D’Alembert’'s Principle, especially 
with regard to requiring only velocity-level vector kinematics. 


5.3.3. Redundant Coordinate Systems and Constrained Motion 


Here we extend Lagrange’s equations to consider redundant coordinates subject 
to Pfaffian non-holonomic constraints. Recall our path to Lagrange’s equations 
for a system of N particles. 


Consistent Virtual Displacements: - = f., dR; =0 


Newton’s 2nd Law: : + fe, — mR; = 0 
Virtual Work: OW; = (fi + fe; — mR;) - OR; =0 


5.142 


5.143 
5.144 


( 
( 
( 
(5.145 


) 
) 
) 
Virtual Work Becomes: 6W; = i —mR,)-6R; =0 ) 


Total Virtual Work: dW = Su fi—-mR 1): 0R;=0 (5.146) 


Introduce Generalized Coordinates: R; = ee Magidnsb) (5.147) 


We made us of R; = Ri(q,.-- , dn, t) to write 








bRi = )- oe (5.148) 
j=1 


q 
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so that the virtual work dW of Eq. (5.146) can be re-written as 


N N 
= 3 (1-2 ioe = Date ee oe) dq; =0 (5.149) 


j=l w=1 





We previously defined the generalized force 


N 
OR; 5 
w=1 


and we proved the identity 


OT OT 
mR SEs aaa p= 1,2,...,n 5.151 
y j ale 0g; : ( ) 


that that Eq. (5.149) becomes 


6W = > e+ 5, Ba; -2(F)| ow =0 (5.152) 


Now, in the previous developments of section 5.3.1, we assumed n was the 
number of degrees of freedom (which implicitly means all holonomic constraints 
have been eliminated, and that {q,...,q,} are a minimal set of independent 
coordinates). For this case, we argued that the virtual displacements 6q; could 
be chosen arbitrarily — Eq. (5.152) can only be satisfied if each bracketed | |; 
coefficient of 6g; must vanish independently — leading to the most familiar 
forms of Lagrange’s equations. 

However, if {q1,.-. ,@n} are not independent, and constraints are present, 
then we cannot set the coefficient of dq; in Eq. (5.152) to zero. In particular, 
consider the case of m differential non-holonomic constraints of the Pfaffian 
form 


> And; + Be =0 k=1,2,...,m (5.153) 
j=l 


or, along an trajectory, we have the differential constraint 


S> Anjdqj + Bedt=0 k=1,2,...,m (5.154) 
j=l 


For instantaneous virtual displacements consistent with these constraints in 
Eq. (5.154), we have 


Y Aga 0> bata (5.155) 
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Any m of the n 6q;’s could be solved from the algebraic equations in (5.155) 
as a function of the remaining (n — m) dq,’s analogous to the above develop- 
ments for the Lagrange multiplier rule. These m equations could be used in 
Eq. (5.152) to eliminate m 6q;’s. Recollection of the terms would give virtual 
work as a constrained variation function of (n — m) 6q;’s which can be chosen 
independently. Again, analogous to the development of the Lagrange multiplier 
rule, it is easy to argue that the following Lagrange multiplier rule “automates” 
all possible differential constraint eliminations: 


n 


w=>> 


5S 


m 


OT d (OT 
Q+ odd + 5 a (Be) 


=i : 6q; =0 5.156 
a 5 dt OG; qj ( ) 








Leading to the constrained version of Lagrange’s equations of motion 


d (0T OT s 

oof eH | ea SS Oe AprAki pS De. 5.157 

dt (s5) 0q; Ot Rome : aia ( 
j=l 


constituting an (n+ m) differential-algebraic system of equations in the (n-+m) 
unknowns 


{a (t), ot -,Gn(t), Ar (4), Bee 1 Am (t) } 


We mention that a more convenient version of Lagrange’s equation, in lieu 
of Eq. (5.157), can be written as a generalization of Eq. (5.141) as 


d (aL aL . 
Be eee a ere D N\Ak; PW Ok e283 5.159 
a (an) aq; td a . pe 
Where £=T-—V,V =V(q,.--,Qn) is the potential energy function, Q; = 
— 8, fi = Frcs — VV; and Ques = Dida fei * FE. 


Example 5.10: Consider the particle sliding in a rotating tube as shown in 
Figure 5.12. The forces are shown in the free-body diagram. F% is the normal 
reaction force due to interaction of the mass ™m with the tube wall. First, we 
develop the equations of motion using Newton's second law 


F=mR (5.160) 
From kinematics we find that 
R= (#'—r6?)é, + (6 + 270) Ep 
and introducing the kinematic constraint 6 = Q =constant, we have 


R= (# —rO?)é, + (27D) Eo 
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Nonlinear Spring 


F(r) =-kyr-kyr? 
Figure 5.12: Particle Moving in a Rotating Tube 


From the free-body diagram, we have 
F = —(kir + kor®)é, + (Fo)éo 
so the equations of motion are 
—(kir + kar*)é, + Foép =m [(# — rO”)ép + (27-Q)Eo| 
leading to the scalar differential equation 
mi — mr = —kir — kor? 
and the constraint force 


Fo = 2mrQ 


(5.161) 


(5.162) 


(5.163) 


(5.164) 


Secondly, we consider a first form of Lagrange’s equations. As the first case, 
let us consider a minimal coordinate formulation (following the developments 
of section 5.3.1. The general position and velocity vectors for a particle in a 


moving plane, as a function of polar coordinates, is given by 
R=ré, R=(r)é,+(rO)éo 
Imposing 6 = Q =constant gives 
R= ré, + rM€o 
The kinetic and potential energy functions are 


1 


— gmk. R= 5m(i? +170?) 
V= shir? + char 


The Lagrangian L is given by 





1.2 ky mO?\ 5 1, 4 
ep th ese 
LE V amr +( 5 + 5 \r qker 


(5.165) 


(5.166) 


(5.167) 


(5.168) 


(5.169) 


Using Lagrange’s equations in the form of Eqs. (5.141), we see that all forces 
acting on m are conservative, except for Fgé9. However, Fé¢ does no virtual 
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work (because (Feég) - (dré-) = 0 ) — therefore Qnc = 0 and the equations 
of motion from Eqs. (5.141) reduce to 


d (OL OL ; 


For the one-dimensional dynamical system considered in this present example 


this yields 
iz (=) ier 
dt \ or Or 
and specifically, substituting Eq. (5.169) gives 
mi + (ki — mQ?)r? + ker? =0 (5.170) 


Both Eqs. (5.163) and (5.170) give the identical differential equation of mo- 
tion, which can be written as 


# + (af — 7)r? + adr? =0 (5.171) 


with 


mw 
Il 
3 | 
oe 
ll 
Sie 


(5.172) 


Thirdly, we can use a redundant coordinate set (7,0), and make use of the de- 
velopments presented in the current section, namely Eqs. (5.158) and (5.159). 
The kinetic energy, for general planar motion, is 


T= smi? +1r76") (5.173) 


and the Lagrangian is 


7 lig 1 on ki 2g koa 
L=T Vint + 5mré at kg (5.174) 
The constraint 6 = = constant is written as the Pfaffian form 
6—-2=0 (5.175) 


We note that Eq. (5.175) is the particular case of Eq. (5.158). Taking 
(q1, G2) = (7,0), we have by direct inspection: 


Au=0 Ap=1 B=2 (5.176) 


The equations of motion follow from Eq. (5.159) as 


d (OL OL 
a (=) ae 


d (OL OL 
di (F) eg 


(5.177) 
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Carrying out the differentiations, by substituting Eq. (5.174) into (5.177) we 
have 


mi — mré? + kir + ker? =0 (5.178) 





mr?6 + 2mr76 +0 =X (5.179) 
Imposing the constraint of Eq. (5.175) on Eqs. (5.178) and (5.179), we obtain 


mi + (ky — mQ?)r + kor? =0 (5.180) 
A = 2mrrQ = rFo (5.181) 


We see that Eq. (5.180) is identical to Eqs. (5.170) and (5.171), whereas 
is the moment causes by the constraint force Fg = 2mrQQ. 


5.3.4 Vector-Matrix Form of the Lagrangian Equations of Mo- 
tion 


We note that the Lagrangian equations of motion in Eq. (5.159) and the system 
of Pfaffian constraints can be written in the vector-matrix form 


é (<<) = Fe = Onc + LAID (5.182) 
and 
[Alq+ B=0 (5.183) 
where 


L(q, q; t) at T(q, q; t) oe V(q, t) 


Z OR; = OR; _ OR; 
Qne = col (Sofie SES Io dq Dd Frcs 











N _ oN . N : 
= col tS nex’ ett neg? Tat 
T 
q=(a @ dn) 
A= 1 d2 oe 
Ay Ate Ain 
Ao, Age Aon 
| = [A(@)] 
Ami Am2 Amn 
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Once a vector basis for expressing positions and velocities has been selected, 
more explicit Lagrange’s equations of motion can be written. Starting with the 
velocity expression in the vector form of 


OR; < : 
pt Pied i=1,2,...,N (5.184) 





R= 


Letting *{R;} denote a matrix of components of R; in frame F and similarly 
for vectors * { Hi} and * {v;,}, then the vector equations of Eqs. (5.184) can be 
written as the corresponding matrix equations 


FIR} = {BI + Se i=1,2,...,N (5.185) 
k=1 
or 
FIR} = {Bh vata i=1,2,...,N (5.186) 
where 


G=(h 4---Gn)* 
[Va] = [7 {Va} 7{Vio} +++ F{Vin}] 


We elect to delete “F” and simply understand that all vector’s components are 
taken in some reference frame, thus we write Eq. (5.186) as 


{R;} = z} +(Vi{@} 71=1,2,...,N (5.187) 


The 3 x 3 partial velocity matrices [V;] are important, because they directly 
parameterize the system mass matrix, as will be seen. Note the vector version 
of kinetic energy, for a system of particles, is written as 


N 
1 ae: 
T= 2 mk -R; (5.188) 
The corresponding matrix expression for T is 
ix 
7 oe ae 
T= 2 2m Ri} {R;} (5.189) 
Substitution of Eqs. (5.187) into Eq. (5.189) gives 


I. 
T2 = 54 [Mla (5.190) 
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and 
1 
T= 5f' [Mla+ Ti + To (5.191) 
where the symmetric positive definite system mass matrix [M] = [M]? is defined 


as an explicit function of the [V;] matrices: 








N 
[M(q)] = 55 mi[Vi]7 [Vi] (5.192) 
i=1 
The remaining two energy components T; and To are defined as 
N T 
T= » {=} (Vilq (linear in q) (5.193) 
N T 
1 OR; OR; Sua! 
To = 5 SS { ey \ { ey \ (does not contain q) (5.194) 


i=1 
Substitution of Eqs. (5.191) — (5.194) into Eq. (5.182) gives 
d wf OR: |" 
¢(oaa+3-{ =} ml) 
1 OM 1 OM 1 OM 
Se ese elie a | les | tee ieee 
~ (34 | ad S| 28 Fe) 
OL. OT. OV: 


agen —ae ——, T 
3g + 3g uae Qne + [A]* A 





which is rearranged to the form 


[M]@ + G(q,4) = Qne + [A]7A (5.195) 
[Alg+ B=0 (5.196) 


where 
N ae 
G(a.4) = (What £ (>: {sh ni) 


1.,/0M].1.,/e@M 1.,/aM 
EGA eee NN Be cin ca eal 
id (54 | wm | 59 Sal Ma 4) 





O 
—~—(Ip +7T,—-V) (5.197 
a a ot 41 ph ) 
Finally, the nonlinear term can be simplified to the form 
G(q,q) = (5.198) 


Example 5.11: Will do the five bar mechanism here 
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Problems 





Figure 5.13: Illustration of a Pendulum with a Linear Torsional Spring 


5.1 


Consider the system shown in Figure 5.13. The pendulum has a weightless rod 
of length R. In addition to gravity, consider the torsional linear spring (moment 
= —k0, spring potential energy = $k67). Your tasks are to derive the equations 
of motion using: 


a) Newton's laws 


b) Euler's Equations of motion (LL = H), taking moment about pivot point 
O. 


c) A version of Lagrange’s equations 








Figure 5.14: Illustration of a Particle Sliding Inside a Frictionless Ro- 
tating Circular Tube. 
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Consider the particle of mass m sliding with out friction in a rotating circular 
tube as shown in Figure 5.14. The angular rate ¢ = 2 is constant. 


2) 


Formulate the “minimal coordinate” version of the kinetic energy T'(0, 0) 
and potential energy V(0) and derive the equations of motion using La- 
grange’s method. Find all equilibrium points Qeq for which 6=6=0. 
Investigate the stability of all points as a function of Q over the range 
0<Q< oo. Verify that Q = J/g/r is a critical frequency where stability 
properties change. 


Formulate kinetic and potential energy as a function of the redundant 
coordinates (r, ¢, 8) 


T =T(r,¢,0,7,¢,6) V =V(r, 4,9) 


Use the Lagrange multiplier rule and Lagrange’s equations in the form 
d ac) aL OW 
~ (= )- = =@;4+0% 
dt G dq; *” = 04; 

with the generalized coordinates 


(1, 492,93) = (7,0, 4) 


and the holonomic constraints 





wri(r, d, 9) =r—-R=0 
Y2(r, ?, 0) = 9 — Ot =0 


Derive the system equations, determine the Lagrange multipliers (Ai, A2) 
as functions of (0,0,Q,R,m) and eliminate them to verify the equation 
of motion of a). 











Figure 5.15: Illustration of a Spring Connected Two-Particle System. 
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5.3 


Consider the two-particle system shown in Figure 5.15. The particles move along 
a straight line on a frictionless plane. The un-stretched spring length is d, so 
that the force acting on my is k[(a2 — 21) — d] = k(x12 — d). Consider two sets 
of generalized coordinates: 


Set I: (q1, 92) = (1, 22) 

Set Il: (qi, g2) = (Xe, £12) 

with vw. = mm (M121 + m2x2). Your tasks are to: 
a) Formulate the equations of motion using 


i) Newton's Laws 
ii) Lagrange’s Equations 


b) Starting with the equation of motion for Set | arranged in the matrix form 


[M] ) =F 
2 
First derive the 2 x 2 constant transformation matrix [A] 
1 Xe 
(=) = (ca) 
2 12 
and verify that the part a.i) differential equations are obtained from 


ial" iaatal (¢% ) = i" 


©12 














Figure 5.16: Illustration of a Spring and Dashpot Connected Three- 
Particle System. 
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5.4 


Consider the three-particle system shown in Figure 5.16. The particles move 
along a straight line on a frictionless inertially fixed plane. The un-stretched 
lengths of the linear springs are di; so that the force acting on m1 is 


kia [(w2 — ©1) — dig] + c12(%2 — &1) + k13 [(v3 — v1) — dig] + c13(4%3 — #1) 


Consider the following three sets of generalized coordinates: 
Set: (qi, 92,93) = (#1, £2, v3) 
Set Il: (qi, 92,93) = (#12, £23, £3) 
Set III: (qi, g2, 93) = (12, £23, Le) 


with wij = %j — Ui, To = A(mixi + m2x2 +m323) and m = mi +m2+m3. 
Your tasks are as follows: 


a) Formulate the equations of motion for each set of generalized coordinates 
using 


i) Newtons Laws 
ii) Lagrange’s Equations 


b) Starting with the differential equations of motion derived from the Set | 
written in the matrix form 


[M]@ = F(a) @ = ("1, 02,03)" 
first derive the 3 x 3 transformation matrices [A] and [B] such that 


x = [Alyy = (x12, 23,23)" 


w = [B]zz = (x12, £23, te)" 


Then introducing « = [Aly and a2 = [B]z into [M]% = F(a) find the 
transformed differential equations 


and verify that these are identical to the results for coordinate sets II and 
Il in part a). 
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my) 
(Xo, y2) 


Yan, 








Figure 5.17: Illustration of a Planar Spring and Dashpot Connected 
Three-Particle System. 


5.5 Consider a three-particle system moving on a frictionless, inertially fixed plane 
as shown in Figure 5.17. Generalize the results of problem 5.4, with the three 
coordinate choices 


Set |. X7= (a1 Yr G2 Y2 £3 ys) 
Set ll: Y"=(ai2 yi2 223 yos «3 ys) 
Set Il: Z7 =(ai2 yio 223 yos Le Ya) 
where 
Lig = Xj —- Li Yig = YG Yi 


1 
Le = — (Mi x1 + Mere + M343) 
m 


1 
to (miyi + may2 + m3y3) 


Verify that setting either y; = 0 or x; = O one can obtain the differential 
equations found in problem 5.1. 
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CHAPTER SEVEN 


Nonlinear Spacecraft 
Stability and Control 





ONSIDER a spacecraft which is to be reoriented to a new heading. It 

is possible to prescribe a corresponding trajectory and then derive the re- 
quired control effort through inverse dynamics which will accomplish the desired 
maneuver. Such maneuvers are called open-loop maneuvers since no position or 
velocity feedback is present to indicate how accurately these maneuvers are being 
accomplished. Naturally, any real system will not be modeled perfectly and un- 
modeled dynamics and external influences will cause the spacecraft to drift from 
the desired trajectory or final state; i.e., the inverse solution for the open-loop 
contains modeling approximations. To guarantee stability of the maneuver, a 
feedback control law is required. This control law operates on measured updates 
of the current states and compares them to the where the spacecraft should be 
at any instant of time. The state errors are then used to modify the control 
input such that the spacecraft returns to the desired trajectory. Open-loop ref- 
erence maneuvers are not always required to perform reorientations. In several 
control laws, spacecraft are reoriented to the new attitude by simply feeding the 
difference between current and final desired attitude to the control law. 


This chapter will develop several control laws for both the regulator problem 
(maintaining a fixed orientation or configuration) and the trajectory tracking 
problem, and discuss their stability characteristics. Designing spacecraft atti- 
tude control laws combines the skills of rigid body kinematics and kinetics, as 
well as control methodology. In fact, the proper choice of attitude coordinates 
can be crucial to the usability of the resulting control law. If large, arbitrary 
rotations are to be performed, clearly any set of the Euler angle family would be 
a poor choice due to their small non-singular rotation range. Attitude control 
laws that make judicious use of various attitude coordinates will be presented. 
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7.1 Nonlinear Stability Analysis 


To design the nonlinear control laws and study their stability, typically Lya- 
punov’s direct method is used. This section will briefly discuss and review the 
basic concepts involved in nonlinear stability analysis. It is not intended as a 
complete study of nonlinear stability and control theory. Instead, our goal is to 
provide enough insight into the essence of Lyapunov stability theory to allow the 
reader to follow the developments of the attitude control laws and their stability 
proofs. The reader is assumed to already be familiar with basic linear control 
concepts. Representative references for linear control theory are references 1 
and 2. For a more complete study of nonlinear stability analysis and control 
theory, the reader is referred to references 3-5. 


7.1.1 Stability Definitions 


Let x be a generalized state vector, then nonlinear dynamical systems can be 
written in the form 


é = f(a,t) (Fl) 


If the function f(x, t) does not explicitly depend on time, then the dynamical 
system is said to be autonomous. Otherwise the system is said to be non- 
autonomous. A spacecraft unfolding its solar panels at a prescribed rate would 
yield a non-autonomous dynamical system, since its inertia matrix would be 
time dependent. Let w be the autonomous feedback control 


u= g(a) (7.2) 
then the closed-loop dynamical system is given by 
= f(a, u) (7.3) 


To define stability of a dynamical system, the notions of an equilibrium state 
z- and nominal reference motion x, are required. 


Definitionn 7.1 (Equilibrium State) A state vector point x. is said to be 
an equilibrium state (or equilibrium point) of a dynamical system described by 
x = f(x,t) at time to if 


f(x.,t) =0 Vt> to 
Therefore, once the system reaches the state a,, it will remain there for all 
time. Equilibrium states can be thought of as the “natural states” of the system. 


Consider a free-swinging vertical pendulum. Its natural equilibrium state would 
be being hanging straight down at rest, or perhaps inverted. 


Example 7.1: Let us evaluate the equilibrium states of a undamped spring- 
mass system with a nonlinear spring stiffness. 


m+ kyx + kox? =0 
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The stiffnesses ky and kz are positive scalar constants. To write these equa- 
tions in the form of Eq. (7.1), the state vector a is introduced. 


r= =. 
v2 x 
The dynamical system is then written as 
‘ v2 
“z=f(x)= 
f(x) emer) 
m m™m 


To find all equilibrium states, the function f(a) is set equal to the zero vector. 
The first component immediately indicates that any equilibrium state of this 
system must have x2 = 0. Setting the second component equal to zero yields 


three possible roots. 
/ ki 
=0 d =—+,/—-— 
1 an XL ies 


Since solely real solutions are of interest for this spring mass system and 
k; > 0, the only equilibrium state vector is found to be a. = (0, 0)". 





If the dynamical system is to follow a prescribed motion, then this motion 
is referred to as the nominal reference motion x,(t). To describe the proximity 
of one state to another, the notion of neighborhoods is defined. 


Definitionn 7.2 (Neighborhood Bs) Given 6 > 0, a state vector a(t) is 
said to be in the neighborhood Bs(a,(t)) of the state x,(t) if 


let) —a-(H)|| < 6 => — a(t) € Be(a-(t)) 


Since the norm used in the Definition 7.2 is the standard Euclidean norm, neigh- 
borhoods can be visualized as being n-dimensional spherical regions (balls) of 
radius 6 around a particular state a(t). 

A simple form of stability is the concept of a motion simply being bounded 
(or Lagrange stable) relative to #,(t). Note that x(to) could lie arbitrarily close 
to x,(to) while x(t) may still deviate from x,(t). The only stability guarantee 
made here is that this state vector difference will remain within a finite bound 


é. 


Definitionn 7.3 (Lagrange Stability) The motion x(t) is said to be Lagrange 
stable (or bounded) relative to x,(t) if there exists a 6 > 0 such that 


a(t) € Bs(a,(t)) Vt>to 


Declaring a motion to be Lyapunov stable (also referred to simply as being 
stable) is a stronger statement than saying it is Lagrange stable. With stability 
it is possible to keep the difference between x(t) and 2,(t) arbitrarily small. 
Let us first define stability relative to x,(t). Stability relative to an equilibrium 
point is a special case of this more general setting. 
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Definitionn 7.4 (Lyapunov Stability) The motion x(t) is said to be Lya- 
punov stable (or stable) relative to x,(t) if for each € > 0 there exists a d(€) > 0 
such, that 


x(to) € Bs(x,(to)) => a(t) € B.(ax,(t)) Vt> to 





State Space 


Bled) 














Figure 7.1: Illustration of Lyapunov Stability Definition 


In other words, if the state vector a(t) is to remain within any arbitrarily small 
neighborhood B, of x,(t), then there exists a corresponding initial neighborhood 
B;(x,(to)) from which all x(t) must originate. This concept is illustrated in 
Figure 7.1. If a(t) is not stable, then it is said to be unstable. If the reference 
motion x,(t) is an equilibrium state #-, then Definition 7.4 simplifies to: 


Definitionn 7.5 (Lyapunov Stability) The equilibrium state x. is said to 
be Lyapunov stable (or stable) if for each € > 0 there exists a d(€) > 0 such that 


a(to) € Bs(a-) => a(t) € Be(a-) Vt>to 


These stability definitions only guarantee that the motion will remain arbitrarily 
close to the desired target state, provided that the initial state is close enough 
to the target state. Nothing is said whether or not the motion will actually 
converge to the target state. 


Example 7.2: Let us analyze the equilibrium point stability of the simple 
spring-mass system 
mi + ka = 0 


using the Lyapunov stability definition. Writing the dynamical system in state 
space form we get 


e=se)=(" je (7.4) 


where w = (a,@)7 and a. = (0,0)7. Solving the second order differential 
equations analytically, the trajectory x(t) is found to be 


x(t) = Asin(wt + ¢) 
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where w = /k/m is the natural frequency, ¢ is the phase angle and A 
is the oscillation amplitude. The spring stiffness k is assumed to be larger 
than the mass m, therefore w > 1. Note that both A and ¢ are determined 
through the initial conditions. Assume that the all initial states a(to) are in 
a neighborhood Bs of a, then 


|2(0)|| = V.x(0)? + &(0)? = Av/1 + (cos? $) (w? — 1) 


Depending on the phase angle, the initial state magnitudes will vary between 
A < ||x(0)|| < Aw since w > 1. Therefore, if all ||a(0)|| € Bs(ae), then 


6 = Aw 
The state vector magnitude for t > 0 is 
||a(t)|| = Av/1 + cos?(wt + d)(w? — 1) 
Since w > 1, this is bounded from above by 
||x(t)|| < Aw =6 


For a given € > 0, to guarantee that any trajectory x(t) € B.(a-), the initial 
neighborhood size 6 must be chosen such that 6 < e«. Note that in order 
to prove stability, it was necessary to solve for x(t). For this simple linear 
system this was possible. However, for general nonlinear system this becomes 
exceedingly difficult. 


A stronger stability statement is to say the motion a(t) is asymptotically 
stable. In this case the difference between a(t) and x,(t) will approach zero 
over time. 


Definitionn 7.6 (Asymptotic Stability) The motion x(t) is asymptotically 
stable relative to x(t) if x(t) is Lyapunov stable and there exists ad > 0 such 
that 


x(to) € Bs(ar(to)) == jim x(t) = a,(t) 


In other words, there exists a non-empty neighborhood of size 6 around 2,(to) 
wherein each a(to) results in a motion that asymptotically approaches 2,(t). 
This result could again be simplified for the case of asymptotic stability of an 
equilibrium state by setting z,(t) = a. Note that asymptotic stability only 
guarantees that the state error will approach zero, yet it does not predict any 
specific decay rate. 


Definitionn 7.7 (Exponential Stability) The motion x(t) is said to be ex- 
ponentially stable relative to x,(t) if x(t) is asymptotically stable and there exists 
a0 >0 and corresponding a(d) > 0 and \(6) > 0 such that 


w(to) € Bs(wr(to)) => ||a(t) — a,(t)|| < ae~*'||ar(to) — er(to)|| 
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Therefore exponential stability guarantees that the state errors will decay at 
least at a rate A. Of all the stability definitions presented, the concept of La- 
grange stability is clearly the weakest, while exponential stability is the strongest 
statement. Unfortunately, proving exponential stability is also the most chal- 
lenging. 

Except for the Lagrange stability definition, all other types of stability de- 
fined are referred to as local stability. The initial state vector has to be within a 
certain neighborhood Bz relative to the desired state vector for stability to be 
guaranteed. If stability is guaranteed for any initial state vector x(to), then the 
system is said to be globally stable or stable at large. 


Definitionn 7.8 (Global Stability) The motion x(t) is said to be globally 
stable (asymptotically stable or exponentially stable) relative to x,(t) if a(t) is 
stable (asymptotically stable or exponentially stable) for any initial state vector 
x(t). 


7.1.2 Linearization of Dynamical Systems 


For design purposes and to perform stability analysis, many nonlinear dynamical 
systems are linearized about a nominal reference motion #,(t) which is defined 
through the differential equation z, = f(x,,u,). This allows for standard linear 
control techniques and stability theory to be applied. Assume the dynamical 
system a(t) is defined through « = f(x,u). The control effort error du is 
defined as 


ju = U— Uy, (7.5) 
and the state error vector 6a be defined as 
62 = “2-2, (7.6) 
The derivative of da is written as 
62 = x2 — &, (7.7) 
Performing a Taylor series expansion of « about (a,;,u,) we obtain 
6a = f(a, ur) + CP Grote) 5 + CPt) sy + H.O.T — f(a@,,u,) (7.8) 


After dropping the higher order terms, this leads to the linearized dynamical 
system 


. Of (Xr, Ur) Of (Lp, Ur) 
Defining the two Jacobian matrices to be the time-varying matrix functions 
Of (@p, Ur) 
(4) = (7.10) 
[B] = OF (erst) (7.11) 


Ou 
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the linearized system is written in the standard form 
da ~ [Aloa + [Blow (7.12) 


If the nominal reference motion «,(t) is simply an equilibrium state a,., then 
the state vector x is typically expressed relative to w,. Therefore, having x = 0 
implies that the system is at the equilibrium point. The nominal control u,. is 
zero in this case. The linearized dynamical system about the equilibrium state 
Ze is expressed as 


a ~ [Ala + [Blu (7.13) 


Note that since the original nonlinear system « = f(x,u) was assumed to 
be autonomous, the generally time varying matrices [A] and [B] are constant 
matrices for this case. 

Linear stability analysis can now be used on either Eq. (7.12) or (7.13). 
However, note that any stability claim resulting from this analysis will inherently 
only be a local stability claim. Any stable linear system is inherently globally 
exponentially stable. However, just because a linearized dynamical system is 
stable does not imply that the nonlinear system will be globally stable. Using 
linear stability theory on the linearized dynamical system only guarantees that 
there exists an non-empty neighborhood B; about the reference motion 2,(to) 
from which all nonlinear motions a(t) will be stable if x(to) € Bs(a#,(to). 


Example 7.3: Let us find the linearized equations of motion of the nonlinear 
dynamical system 


mi +cé + kia + kex? =0 


about some reference motion x,(t). The given oscillator system has a cubi- 
cally nonlinear spring with stiffness k2. To write this second order differential 
equation in state space form, let us introduce the state vector a as 


-() 


The dynamical system is then written as the first order differential equation 


x 
é=t@)=( k k2 3 .) 
—Sa- Sa-Su 


Using Eq. (7.10), the Jacobian matrix [A] is found by taking the first partial 
derivative of f(a) with respect to the state vector «x. 
of 0 1 
a)= 32 =| | 


al a ki _ 9k2,.2 
Ox “329 a 


The linearized dynamical system about the reference motion 2,(t) is then 
expressed as 
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If the reference motion is simply z(t) = 0, then the linearized motion about 
the origin simplifies to 


; 1 
bis ~ fs . | ba 
Note that the linearized system can be used to establish local stability guaran- 


tees. To verify that the nonlinear damped oscillator system is indeed globally 
stable further analysis is needed. 


For zero control effort u, the linearized system in Eq. (7.13) is stable if 
no eigenvalues of [A] lie on the right half side of the complex plane (i.e. no 
eigenvalues with positive real parts). The system is said to be strictly stable if all 
eigenvalues have negative real parts. This guarantees that all states will decay to 
zero. The system is marginally stable if all eigenvalues are on the left half plane 
and at least one eigenvalue is purely imaginary. The modes corresponding to 
the imaginary eigenvalues will exhibit an oscillatory, non-decaying motion. The 
following theorem provides the conditions from which local nonlinear stability 
can be concluded from linear stability analysis. 


Theorem 7.1 (Lyapunov’s Linearization Method) Assume the linearized 
dynamical system is found to be 


1. strictly stable, then the nonlinear system is locally asymptotically stable. 
2. unstable, the the nonlinear system is unstable. 


&. marginally stable, then one cannot conclude anything about the stability of 
the nonlinear system without further analysis. 


This theorem is also referred to as Lyapunov’s indirect method. The theorem 
makes intuitive sense. If the linearized system is either strictly stable or unsta- 
ble, then one would expect that a neighborhood would exist where the nonlinear 
system would also be either stable or unstable. However, if the linearized sys- 
tem is only marginally stable, then the neglected second and higher order terms 
could render the nonlinear system either stable or unstable. 


7.1.3. Lyapunov’s Direct Method 


Proving stability of nonlinear systems with the basic stability definitions and 
without resorting to local linear approximations can be quite tedious and dif- 
ficult. Lyapunov’s direct method provides a tool to make rigorous, analytical 
stability claims of nonlinear systems by studying the behavior of a scalar, energy- 
like Lyapunov function. A major benefit of this method is that this can be done 
without having to solve the nonlinear differential equations. To visualize the 
concept of Lyapunov’s direct method, imagine a ball rolling down a steep U- 
shaped canyon. Having the ball roll down the center of the canyon is assumed 
to be the nominal reference motion. Initially, the ball is at rest half-way up 
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the smooth canyon wall. After release, the ball will roll down toward the val- 
ley center, overshoot and rise up on the other canyon wall. However, due to 
the conservation of energy, as long as the other wall is at least as high as the 
previous one, there is no way the ball can escape the canyon (be unstable). 
Instead it will roll down the canyon oscillating from wall to wall resulting in 
a locally stable motion. This example is only locally stable since the ball has 
to start within the canyon to guarantee stability. If friction drag effects are 
included in this study, then the oscillations will eventually dampen out and the 
ball motion will asymptotically track the canyon center. Here stability can be 
rigorously guaranteed by only looking at the total kinetic and potential energy 
of the system without having to actually solve for the resulting motion. 

To mathematically create a virtual “canyon” around a target state x,, the 
concept of positive definite functions is important. These functions are zero at 
the target state (e.g., the canyon floor) and positive away from the target (e.g., 
the canyon walls). 


Definitionn 7.9 (Positive (Negative) Definite Function) A scalar contin- 
uous function V(a) is said to be locally positive (negative) definite about x, if 


e=2, = V(x) =0 
and there exists a 6 > 0 such that 
Vae Bs(a,) = V(x) >0 (V(x) <0) 


excluding x = «x,. If the above property is true for any state vector x, then 
V(a) is said to be globally positive (negative) definite. 


If a function is positive definite in a finite region around a target state, then 
this guarantees that this scalar function has a unique minimum at a,. Since 
dynamical systems naturally tend toward a state of minimum total energy, the 
fundamental importance of this method becomes clear. Similarly the concepts 
of negative definite and semi-definite functions can be defined. A function V(x) 
is negative definite if —V(a) is positive definite. 


Definitionn 7.10 (Positive (Negative) Semi-Definite Function) A scalar 
continuous function V(a) is said to be locally positive (negative) semi-definite 
about x, if 

L=2, = V(x) =0 
and there exists a 6 > 0 such that 


Vae Bs(a,) => V(a)>0 (V(x) <0) 


excluding x = «,. If the above property is true for any state vector x, then 
V(a) is said to be globally positive (negative) semi-definite. 
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If a function is only semi-definite, then this function may have extremas other 
than the desired target state. If the canyon had uneven walls with dips and 
rises, then it is possible for the ball to come to rest in such a “local valley” and 
not continue on to the center of the canyon. However, just because a function 
is only semi-definite near a reference state x,, does not guarantee that other 
local minima or maxima of V(a) exists. A matrix [A] is said to be positive or 
negative (semi-) definite if for every state vector x 


>0 = positive definite 
>0 = positive semi-definite 


x’ [Kl : . 
<0O = negative definite 


(7.14) 
<0 = negative semi-definite 


To prove stability of a dynamical system, special positive definite function called 
Lyapunov functions are sought. 


Definitionn 7.11 (Lyapunov Function) The scalar function V(a) is a Lya- 
punov function for the dynamical system « = f(x) if it is continuous and there 
exists a 6 > 0 such that for any x € Bs(a,) 


1. V(x) is a positive definite function about x, 
2. V(a) has continuous partial derivatives 
3. V(a) is negative semi-definite 


Even though V(a) explicitly only depends on the state vector x, since x(t) is 
time varying, the Lyapunov function V is time varying too. Using the chain 
rule, the derivative of V is found to be 


T T 
V= av L= av f(x) (7.15) 
where the last step holds since x(t) must satisfy the equations of motion « = 
f(a). Therefore the derivative V is often referred to as the directional deriva- 
tive of V along the system trajectory. This idea is illustrated in Figure 7.2. 
The Lyapunov function is illustrated as a “bowl shaped” function over the state 
plane (11,22). If the projection of the motion a(t) onto the Lyapunov func- 
tion V(a) always has a non-positive slope, then V cannot grow larger and the 
corresponding dynamical system is stable about the origin. As will become ev- 
ident in the sequel developments, the Lyapunov function, if one exists, is not 
unique — general stability in-the-large is often provable by any of a large family 
of Lyapunov functions. On the other hand, we will also see that the Lyapunov 
functions generalize the class of functions to which “total mechanical energy” 
belongs, and the simplest way to think qualitatively about Lyapunov functions 
is to simply view them as positive measures of displacement (in the state space) 
from a prescribed reference trajectory 2,(t). 
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Figure 7.2: Ilustration of a Lyapunov Function 


If the following stability definitions are only valid in finite neighborhoods 
B;(zx,), then they are only local stability theorems. However, if the Lyapunov 
function V(x) is radially unbounded (i.e. V(a) — oo as ||a|| — 00), then the 
stability claims are globally valid. To simplify the following theorems, it is 
assumed that the stability of a(t) is always examined relative the origin. If the 
origin is not the equilibrium state or nominal reference motion being examined, 
than a coordinate transformation can always be accomplished such that this is 
the case. 


Theorem 7.2 (Lyapunov Stability) If a Lyapunov function V(a) exists for 
the dynamical system « = f(x), then this system is stable about the origin. 


Note that, as is the case with all Lyapunov stability theorems, if Theorem 7.2 
is not fulfilled, then one cannot conclude that the system is unstable. In this case 
another Lyapunov function or stability theorem must be used to prove stability 
or instability. While using Lyapunov functions allows one to rigorously predict 
stability of nonlinear systems, finding an appropriate function to do so is not 
always a trivial matter. However, in many cases it is beneficial to first use the 
total energy expression as a first starting point for developing the Lyapunov 
function, as is done in the following example. 


Example 7.4: The stability of the spring-mass system studied in Example 7.2 
is verified here using Lyapunov stability theory. The dynamical system is given 


by 
mi+kx =0 


The total kinetic and potential energy of this system provides a convenient 
Lyapunov function of the system motion about the system states & = 0 and 
x=0. 


1 1 
V(a,«) = zi + ake 
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By inspection V(x, %) satisfies the three criteria of Definition 7.11. Note that 
V(a,«) is radially unbounded and therefore any stability guarantee will be 
globally valid. Taking the derivative of V we find 


V(a,&) = (mé+ kx) & 
After substituting the dynamical system this is written as 
V(a,4) =0<0 


Since V is negative semi-definite, the spring-mass system is only stable in 
the sense of Lyapunov, not asymptotically stable. Contrary to the more 
complicated stability proof in Example 7.2, this Lyapunov approach did not 
involve actually solving the equations of motion for x(t), which could be a 
very challenging task to perform for many nonlinear systems. Since for this 
example, the Lyapunov function represents the total energy and its rate is 
shown to be zero for all time, we have also shown the well known truth that 
the total energy for the spring-mass system is conserved. 


Theorem 7.3 (Asymptotic Stability) Assume V(x) is a Lyapunov func- 
tion about x,(t) for the dynamical system « = f(a), then the system is asymp- 
totically stable if 


1. the system is stable about x,(t) 
2. V(x) is negative definite about a,(t) 


Theorem 7.4 (Exponential Stability) Assume V(a) is a Lyapunov func- 
tion V(x) of the dynamical system « = f(x) and the system is asymptotically 
stable, then the system is exponentially stable if there exists scalar constants 
c2 >c, > 0 and X>0, k > 0 such that 


VERY 
2. ci||a||*¥ < V(a) < collal|* 


To guarantee convergence of a(t) to the reference motion x(t) (i.e. asymp- 
totic stability), Theorem 7.3 states that a sufficient condition is V <0. However, 
this is only a sufficient, not a necessary condition. It is possible for a dynami- 
cal system to be asymptotically stable, while the Lyapunov function derivative 
along the system trajectory is only negative semi-definite. In essence, if V does 
vanish at some point other than a,., this point must not be an equilibrium state. 
The following very useful theorem allows one to prove asymptotic stability, if 
this indeed exists, when V(a) < 0 by investigating the higher order derivatives 
of the Lyapunov function.®% 


Theorem 7.5 Assume there exists a Lyapunov function V(a) of the dynamical 
system & = f(a). Let Q be non-empty the set of state vectors such that 


e£eQ —> V(a)=0 
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If the first k —1 derivatives of V(a), evaluated on the set Q, are zero 


d’ 
A ae ae ne 
dx* 
and the k-th derivative is negative definite on the set Q 
d*V (x) 
eee <0 VareEQ 


then the system a(t) is asymptotically stable if k is an odd number. 


Example 7.5: To illustrate Theorems 7.3 through 7.5, the stability of the 
following linear spring-mass-damper system is studied. 


mi+ctz+kx =0 


Again the total kinetic and potential energy is used as a radially unbounded 
Lyapunov function to measure the state errors from the equilibrium states 
x =Oand ¢ =0. 
; Th. 39: hal 95 
V(a,£) = =mz =k 

(2,4) = ama + ake 
Taking the derivative of V(x,#) and substituting the equations of motion, 
the following result is obtained: 


V(a,«) = (ma + ka) & = —cé:? <0 


Note that V is only negative semi-definite, and not negative definite. Even 
though we know from the easy analytical solution that this spring-mass- 
damper system is asymptotically stable, only Lyapunov stability can be con- 
cluded at this point in the analysis. Using Theorem 7.5, the higher order 
derivatives of V are investigated to prove asymptotic stability. The set of 
states 2 where V = 0 is 0 = {(a, @)|@ = 0}. The second derivative of V is 


V = —2cie = 25 (cé + kx) & 
m 


which is 0 when evaluated on the set 2 where ¢ = O. After taking an- 
other derivative and substituting the system equations of motion, the third 
derivative of V is expressed as 


V= 2, ((caé + ka)? + a? + ckart — ka”) 
Evaluated on the set 22, this third Lyapunov derivative simplifies to 


ee k? 
V => 72? 
m 
which is negative definite for for all ~ in 2. Since the first non-zero higher 
order derivative of V is of odd order and negative definite on 2, the system 
is globally asymptotically stable. 
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Note that the previous example does not prove that the given linear spring- 
mass-damper system is exponentially stable (which we know independently to be 
true from the analytical solution). Indeed with the chosen Lyapunov function 
it is impossible to satisfy the two primary conditions in Theorem 7.4. The 
following theorem allows Lyapunov theory to be conveniently used when proving 
various forms of stability of an autonomous linear system. 


Theorem 7.6 (Lyapunov Stability Theorem for Linear Systems) An 
autonomous linear system x = [Ala is stable if and only if for any symmetric, 
positive definite [R] there exists a corresponding symmetric, positive definite [P] 
such that 


[A]? [P] + [PILA] = -[R] (7.16) 
is satisfied. Eq. (7.16) is called the algebraic Lyapunov equation. 


The corollary to Theorem 7.6 is that if we know that [A] is a stable ma- 
trix (ie. all eigenvalues have negative real parts), then we know that for any 
choice of symmetric, positive definite [P] we are guaranteed the existence of a 
corresponding symmetric, positive definite [R]. This property is very useful in 
the following example, and in fact, the proof follows from generalization of this 
example. 


Example 7.6: Let us revisit the linear spring-mass-damper system from the 
previous example using an alternate Lyapunov function. First, we define the 


state vector x to be 
z=(. 
L 


Now we are able to write the second order differential equation of motion in 
first order state space from. 


To study the system stability about the fixed point a = 0, we define the 
candidate Lyapunov function 


where [P] is some positive definite matrix. This causes V(2) to be positive 
definite about the origin. Taking the derivative of V(a) we find 


V =a" ([A]"[P] + [PI[A])@ 


Since [A] is clearly a stable matrix for positive m, k and c, using Theorem 7.6 
we are guaranteed that a symmetric, positive definite [A] exists such that 
[A]? [P] + [P][A] = —[R]. The Lyapunov rate is then rewritten as 


V =a" [Rjex 
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which is negative definite in the state vector a. By choosing this alternate 
Lyapunov function we are able to guarantee asymptotic stability in one step. 
This new V also lends itself to proof that all stable linear systems of the 
form a = [Ala are indeed exponentially stable. From linear algebra it is clear 
that the following Rayleigh-Ritz inequalities must hold for positive definite 
matrices: 3 


APmminllae||? < @[P]@ < APmae |lell” 
ARmin lll? < @[R] ae < ARmas lle” 


min 


where Amin and Amaz are the respective smallest and largest eigenvalues of 
[P] and [R]. If we chose \ such that 


r < ARmin 


Pmax 


then the first requirement of Theorem 7.6 is satisfied. To satisfy the second 
requirement, we chose k = 2 and ci < Ap C2 > ARmaz: 


min? 


7.2 Generating Lyapunov Functions 


Lyapunov’s stability theory provides a very elegant method to guarantee sta- 
bility characteristics of nonlinear dynamical systems without having to actually 
solve the corresponding equations of motion. Also, as will be evident, selec- 
tion of Lyapunov functions can be approached simultaneously with control law 
designs. However, generating appropriate positive definite Lyapunov functions 
is not always a trivial matter. This section presents several Lyapunov func- 
tions that can be used to describe state errors of common aerospace systems. 
These functions are broken up into two categories, namely elemental Lyapunov 
functions that measure velocity or functions that measure position state errors. 
Separate elemental Lyapunov functions are linearly combined to provide the de- 
sired system Lyapunov function. The following motivational example illustrates 
how Lyapunov functions are used to generate control laws and make stability 
guarantees of the closed-loop system. 


Example 7.7: We would like to have a particle m, whose position is given 
by the state vector a, track a reference motion «,(t). The dynamical system 
for this particle is given by Newton’s second law. 


mz =u 


where the control vector wu is the external force being applied to the particle. 
The tracking error da is defined as 


62 = 2-2, 
and the tracking error velocity as 


62 = 2-2, 
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Having both da and 6a go to zero implies that perfect tracking is being 
achieved. To develop an asymptotically stabilizing control law wu, the candi- 
date Lyapunov function V is defined as the “error energy” 


V (da, d@) = sms + shoe” ban 


The first term of V(da, da), which measures velocity errors, is a “kinetic- 
energy-error-like” term. If the reference velocity «, = 0, then it would be the 
kinetic energy of the particle. The second term provides a positive definite 
measure of the position errors. It can be viewed as a “potential-energy-like” 
function. For example, the fictitious potential energy function used here is 
very similar in form to the real potential energy function of a linear spring. 
The parameter & can be thought of as a spring stiffness constant. Taking the 
first time derivative of V we find the “power” or work/energy equation 


V = da" (moa + koa) 


For the closed loop system to be stable, Lyapunov stability theory requires 
that V be at least negative semi-definite. Therefore, we set V equal to 


V = —Péa" da <0 


where P > 0. Note that this V is not negative definite since it does not 
depend explicitly on the position error vector da. Setting these two Lyapunov 
function derivatives equal and using 0a = @—, leads to the following stable 
closed-loop dynamical system. 


mz — max, + kia + Pox = 0 (7.17) 


To find the control law w which will yield these dynamics, the system equa- 
tions of motion are substituted into the closed-loop system, and we solve for 
the required control vector 


u = —kéx — Pox + mx, 


Note that the scalar parameters k and P are position and velocity feedback 
gains that provide stiffness and damping. To guarantee that this control law 
is indeed asymptotically stabilizing, the higher order time derivatives of V 
must be investigated. For this example V is zero whenever di is zero. The 
second (even) derivative of V is 


V =—-2Pda" bz 


which is zero on the set 2 = {(da, da@)|da@ = 0}. The third (odd) derivative 
of V is 


V = —2P6#7 6% — 2P5a7 62 


Substituting the closed-loop dynamical system and setting da equal to zero 
yields 


2 
ii (Se, See = 0) = -2P 6a? 5a <0 
m 


which is negative definite. Since the first non-zero V derivative is of odd 
order, the control law uw is actually asymptotically stabilizing. 
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This example illustrates the powerful fusion of control law design and system 
stability analysis with Lyapunov method. Finding a globally asymptotically 
stabilizing control law and proving the stability guarantees went hand-in-hand 
and were accomplished in a straight forward manner. A drawback to these 
Lyapunov methods is that the process of finding appropriate Lyapunov functions 
is not always obvious. The following two sections present several Lyapunov 
function prototypes that can be applied to many aerospace systems. 


7.2.1. Elemental Velocity-Based Lyapunov Functions 


We consider here a class of mechanical systems to provide physical motivation. 
We first consider the case that only the velocity of a dynamical system is to be 
controlled. Thus the state space of interest is simply (q) and not the classical 
(q,q). The control vector here will be a force or torque type vector. We note 
the developments in this section seeks to rive q — 0, but generally q will not be 
stabilized with input to a particular point. It is convenient to use the system 
kinetic energy expression T’ as the candidate Lyapunov function. For natural 
systems, the kinetic energy can always be written in the quadratic form 

Ts 5a" (Mia (7.18) 
where the vector q is a generalized position state vector. In general, the mass 
matrix [/(q)| is positive definite and symmetric. The standard Lagrange equa- 
tions of motion for a natural unconstrained system are 


(M(a)\4 = —41(4,4)]4 + 547 [Ma(a)]4 + @ (7.19) 


where the vector Q is the generalized forcing term (includes both conservative 
and non-conservative forces). Note that the notation [Mg] indicates the partial 
derivative of the matrix [M] with respect the vector g and the matrix product 


a’ (M4) 4 
q’ (Mq(q)l4 = (7.20) 
a’ (24\ 4 
is an N-dimensional column vector. 


If the reference velocity vector is the zero vector, then Eq. (7.18) itself pro- 
vides a candidate Lyapunov function V. 


V(q) = 54° [M(a)l4 (7.21) 


Since the mass matrix [M] is symmetric, the derivative of V can be written as 


V = @"(Mia+ 547104 (7.22) 
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Substituting for [M]q from the equations of motion in Eq. (7.19), V is reduced 
to 


. ; Leis oD . 
v=" (-Slta + 547 Mala +@) (7.23) 
After noting the identity 
wv . 
qd (47 (Mql@) = 95 & (47 (Mala) = a (Mg (7.24) 
i=1 


the Lyapunov (kinetic energy) time derivative is written as the simple work-rate 
equation? 


V=q'Q (7.25) 


Suitable control vectors Q could now be developed to render V negative defi- 
nite or negative semi-definite. For example, a simple control law would to set 
Q = —[P]q with [P] being a positive definite matrix. This control law would 
asymptotically bring the system velocity q of the system given in Eq. (7.19) to 
rest. 

If the reference velocity vector q, is non-zero, then the Lyapunov function 
is defined in terms of the velocity state error vector dq = q— q, as the “kinetic- 
energy-like” function of departure velocity 


es 
V(4) = 594" [M(q)]6q (7.26) 
Taking the derivative of Eq. (7.26) we find 


; | ee 
V = 6q" (inn + sla1)54) (7.27) 
After making use of the definition of 6q and substituting the equations of motion, 
V is written as 


v= sa" (S10 (54+ ae) + 547 IMald Ile +@) (7.28) 
When tracking a time varying reference state, the elemental velocity-measure 
Lyapunov function rates no longer simplify to the classical power form of the 
work-energy equation in Eq. (7.25). 

When controlling the angular velocities of rigid bodies, the elemental Lya- 
punov function in Eqs. (7.21) is specialized to kinetic energy expression of a 
rigid body given by 


Vw) =T= sow (7.29) 
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where [J] is the rigid body inertia matrix. Note that since the w and [I] compo- 
nents are assumed to be taken in the body frame B, taking the derivative of the 
scalar quantity V involves taking local derivatives of w and [I] as seen by by 
B frame. Using Euler’s rotational equations of motion in Eq. (4.32), the time 
derivative of the Lyapunov (kinetic energy) function is expressed as 


V =u" ([I]Jw) = w" (—[a][T]w + Q) = w7Q (7.30) 


where Q is the total torque vector acting on the rigid body. The fact that [J] 
is constant as seen by the B frame (i.e. rigid body) and that w = Nd/dt(w) = 
4 /dt(w) were used in deriving this expression. 

To measure the angular velocity error relative to some reference rotation 
defined through w,., we define the angular velocity vector 


0W = W — Wy (7.31) 


Since both dw and w have components taken in the body frame 6, and the 
reference angular velocity vector w, is typically given with the components 
taken in the reference frame R, the angular velocity error °5w is computed as 


Bow = 8w — [BR]®w, (7.32) 


The Lyapunov function is written as the kinetic energy like expression 
1 
V (dw) = zo [Ld (7.33) 


The matrix components of dw and [J] are implicitly taken in the 6 frame. Taking 
the derivative of the scalar quantity V involves taking derivatives of the scalar 
B frame components of Eq. (7.33). 

; By 

V= bw" [= (dw) (7.34) 
Using the transport theorem in Eq. (1.21) and the identity in Eq. (4.30), the 
derivative of dw as seen by the 6 frame is given by 

Bq 

a (dw) = Ww — WwW, +W X Ww, (7.35) 
Substituting Eq. (7.35) and Euler’s rotational equations of motion into the Lya- 
punov rate expression in Eq. (7.34), V is expressed as 


V = bw" (—[a] [I]w + w x w, — [T]m, + Q) (7.36) 


Because most mechanical systems are natural systems, the Hamiltonian spe- 
cializes for this case to the total system energy. This motivates the alternative 
use of the Hamiltonian as a more general Lyapunov function candidate. Let 
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L(q,q) be the system Lagrangian. In the previous chapter the Hamiltonian H 
was defined in terms of the canonical coordinates q and p as 


H(q,p) =p" 4-L(4.4) (7.37) 
where p is the canonical (or conjugate) momentum defined 


aL 


= ae (7.38) 


Pp 
After some calculus and using Lagrange’s equations, this leads to Hamilton’s 
canonical equations of motion in terms of the gradient of H with respect to 


(q, Pp). 


. OH 
O 

pee (7.40) 
Oq 


It is important in the partial derivatives of Eqs. (7.39) and (7.40) to consider 
H = H(q,p) rather than H = H(q,q). The generalized coordinate rate vector 
q has been eliminated by inverting Eq. (7.38) for p = g(q,q). Taking the time 
derivative of the Hamiltonian H in Eq. (7.37) we find 


te lien oan OE OL, CO” 
H=p'q+pg-—-— 


= Al 
at oq 1 aq 4 ey) 


After substituting Eqs. (7.38) and (7.40) and setting the Lyapunov function 
equal H, the Hamiltonian (Lyapunov) time rate is written as the modified power 
equation 


OL 


V=H=Q'q-— 7.42 

Qra-F (7.42) 
Generally £ = L(t,q,q), but if £ = L(q,q) is not an explicit function of time, 
such as is the case with natural systems, the Hamiltonian rate reduces to the 


simple work-energy equation 
V = H(q,p) =Q"q (7.43) 


Let the vector F' be the external force being applied to a rigid body, D be 
the external torque vector, and w and R measure angular velocity and inertial 
position respectively, then H is written as 


V=H=L'w+F'R (7.44) 


Note that Eqs. (7.42) through (7.44) are kinematic results that were derived in- 
dependent of the system dynamics! This has two important implications. First, 
when using the Hamiltonian (total energy) as the Lyapunov function of natural 


SECTION 7.2 GENERATING LYAPUNOV FUNCTIONS 225 


system, it is not necessary to differentiate V explicitly and grind through the 
algebra to find an expression for V. Instead, the work-energy rate expressions 
in Eqs. (7.43) and (7.44) can be written directly using some version of the work- 
energy equation. This can save a substantial amount of algebra and calculus. 
Second, any stabilizing control vector Q (that renders V negative semi-definite 
in some state space neighborhood) for the regulator control problem will remain 
stabilizing even in the presence of model errors. This is a direct consequence 
of the V expression being independent of the system dynamics (depends only 
upon forces, moments, and velocities of the points to which forces are applied. 
Therefore, if the inertia or mass matrix is modelled incorrectly, then the same 
control vector Q will still stabilize the system. The stability guarantees of such 
Lyapunov derived control laws, using total mechanical energy as the Lyapunov 
function, are thus very robust to the presence of modelling errors. Naturally 
the performance would differ in the system model was incorrect. It is implicitly 
necessary, however, that the actual system must be controllable and the actual 
Hamiltonian must be positive definite with respect to departures for the tar- 
get state. Otherwise, it is necessary to establish sufficient insight to modify V 
and/or the number of control inputs. Whenever the actual system has addi- 
tional degrees of freedom whose coordinates do not appear in the work/energy 
equation, this idealized analysis may break down, and caution showed be used 
to overstate stability guarantees. 


Example 7.8: Assume the multi-link manipulator shown in Figure 7.3 is to be 
brought to rest. Choosing the inertial polar angles as generalized coordinates, 
the state vector is q = (01, 02,03)". The system mass matrix is then given 
by 


(m1 + me + ms)li 
M(q) = | (m2 + ms)lile cos(O2 — 01) «+ 
mslil3 cos(03 — 61) 


(me + ms3)lile cos(62 — 1) m3lyl3 cos(63 — 1) 
(me + ms3)l3 m32113 cos(63 - 02) 
m3lel3 cos(63 = 02) mal? 


Assuming a torque Q; is applied to each link, then the equations of motion 
for this 3-link manipulator system are given by 


is ee 2 des ‘ 
[M]d + [Mlq— 54° [Mala =Q 
Since the final link orientation is not relevant in this velocity control situation, 


the Lyapunov function is simply chosen to be the total kinetic energy of the 
system given by 


Using Eq. (7.25), the Lyapunov rate is then given by 
V=4'Q 
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Figure 7.3: Three-Link Manipulator System Layout. 


To guarantee that V is negative definite, standard control analysis leads to 
the velocity feedback control law Qi 


Qi =—Piq 


where P is a positive scalar velocity feedback gain. As shown in Refs. 11 
and 12, since the mass matrix [MM] is symmetric positive-definite, using the 
velocity feedback control law Qa 


Qe = —P2[M(q)]q@ 


also leads to an asymptotically stable system with P2 being a different positive 
scalar feedback gain. The configuration variable mass matrix [/(q)] acts 
here as a variable feedback gains which produces some interesting and useful 
feedback performance enhancements. Note that p = [M(q)|q = 5S is the 
canonical conjugate momentum vector. One benefit of Q2 over Qi is that 
Qz2 can easily be shown to be exponentially stabilizing, providing the control 
designer with predictable exponential velocity error decay rate. Property 1 of 


Theorem 7.4 is trivially satisfied by setting A = 2P2. 
V =—Poq" ([M]q = —2P2V < —AV 
To verify property 2, we employ the Rayleigh-Ritz inequality” * which states 
Amin (474) < @7[M]d < Ama (474) 


where Amin and Amaz are respectively the smallest and largest eigenvalues of 
the system mass matrix [J]. Using the definition of the Lyapunov function, 
this inequality is rewritten as 


2Aminligll? < V(q) S 2Amazliql|” 


where the Euclidean norm is used. After setting c1 = 2Amin, C2 = 2Amaz 
and k = 2, the second property of Theorem 7.4 are verified and the control 
law Qo is therefore exponentially stabilizing and V(t) < Voe—**. 

The following numerical simulation compares the performance of the two 
velocity feedback control laws Qi and Qe. The simulation parameters are 
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Angular Velocities [deg/s] 





Control Vector Q [Nm] 























time [s] 


(i) z Vector Components (ii) Control Vector Q Components 


Figure 7.4: Isolated Initial Rotation Stabilization 


Table 7.1: Parameters of Isolated Initial Motion Study 


Parameter Value Units 
l; 1 m 
Mi 1.0 kg 
Py 1.0 kg-m? /sec 
P2 0.72 kg-m? /sec 
«(to) [-90 30 0] = deg 
«z(to) [0.0 0.0 10] deg/sec 


given in Table 7.1. The feedback gains were chosen such that the maximum 
control torque encountered is the same for both control laws. The initial 
conditions are such that only the third link has some initial rotation. The 
other two links are at rest when the stabilizing control is turned on. The 
resulting motion for both control laws is shown in Figure 7.4. While Q1 is 
able to stabilize the system and bring all links to rest, the kinetic energy of 
the third link is partially transmitted to the other two links, thus exciting 
the entire system. However, the control law Q2 behaves quite differently as 
seen in Figure 7.4(i). The first two links remain essentially at rest while the 
the third link is brought to rest separately. This decoupling behavior was 
found will all chains of rigid links and is discussed in detail in References 11 
and 12. The control torque components of each control law are shown in 
Figure 7.4(ii). While Qi has all three torque motors active, Qz2 only drives 
the second and third torque motors. For the same maximum allowable control 
torque, the Q»2 was found to have much better state error convergence to zero 
in the end game. 


7.2.2 Elemental Position-Based Lyapunov Functions 
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This section provides elemental position-based Lyapunov functions that allow 
us to control the position of a body. Analogous to the elemental velocity-based 
Lyapunov functions, the state space of interest here is simply (q) and not the 
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more general (q,q). Note that q is treated as as the control variable. The 
control laws that are developed using purely position-based Lyapunov functions 
are often referred to as steering laws. The control law will determine a desired 
q(t) trajectory that must be followed to stabilize the system about a desired 
position. To achieve this q(t) time history, separate lower level servo loops 
are assumed to be present that will maintain the desired coordinate rate. For 
example, consider the multi-link system shown in Example 7.8. If a position 
based steering law were applied, then it would be assumed that servo loops were 
present on each joint link to maintain the q(t) required by the steering law. 

However, besides leading to system steering laws, the elemental position- 
based Lyapunov functions can also be combined with the elemental velocity- 
based Lyapunov functions to develop control laws that stabilize both velocity 
and position errors. This type of development is shown in the next section. 

To provide a scalar measure of position displacements relative to a target 
state, potential energy-like functions are created which are zero at the target 
state. In many instances it is possible to use an actual mechanical potential 
energy function as the Lyapunov function. Consider a linear spring-mass system 
with the coordinate x measuring the displacement of the spring and the scalar 
parameter K being the spring constant. For this system, the spring potential 
function provides the positive definite measure of the displacement 2. 


1 
V(a) = she (7.45) 
The derivative of V is then 
V = 4 (kz) (7.46) 


To combine the position-based Lyapunov functions later on with the velocity- 
based Lyapunov functions, it is usually be necessary to write the velocity expres- 
sions in the position-based Lyapunov functions in terms of the same velocity- 
coordinates used in the velocity-based Lyapunov function. With many dynami- 
cal systems it is not possible to express the position errors relative to some target 
state in terms of an actual potential energy function, because there may be no 
inherent “stiffness” that attracts the system to the desired state. Instead, a fic- 
titious potential energy function is created which is zero at the target state and 
positive elsewhere (i.e. positive definite about the target state). A standard ap- 
proach to create such a function is to express the position error as the weighted 
sum square of all position coordinates. This is written in matrix notation as 


1 
V(q)=54' [Ka (7.47) 
where the position vector q is assumed to be measured relative to the target 
state. The symmetric matrix [K] must be positive definite to guarantee that 
the Lyapunov function is a positive definite function of g. When using these 
Lyapunov functions to create feedback control laws, the matrix [A] assumes 
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the role of a position feedback gain matrix and also has the perfect analog to a 
system of linear springs. Since [K] = [K]’, the derivative of Eq. (7.47) is 


V = 4" ((K]Jq) (7.48) 


To create a steering law for g, the Lyapunov function in Eq. (7.47) is written 
without the gain matrix [K] as 


1 


Viq)= 544 (7.49) 


Defining the steering q to be 
q=—|K]q (7.50) 


the resulting V = —q"[K]q is negative definite in g. Thus this q steering law 
would bring q asymptotically to zero. Note that in all steering laws (controlling 
q and treating q as a control variable), the system dynamics do not appear. The 
internal servo control loops, which maintain the desired q(t) coordinate rates, 
effectively hide the system level dynamics from the steering law. However, 
every system will exhibit certain limits as to how fast it is able to move and 
accelerate. Steering law gains must be carefully chosen such that the required 
q(t) time histories to not exceed these limits. Otherwise the servo loops will 
not be able to track the required coordinate rates and the steering law stability 
guarantees are no longer valid without further analysis. 

With the remaining position-based Lyapunov functions presented in this 
section, analogous steering laws could be constructed for each system. All these 
control laws demand a specific coordinate rate and assume a lower level system 
servo loop will achieve this desired rate. The advantage of using steering laws 
is that the control designer can focus the control on having the system states 
avoid singularities or other constraints. However, a drawback is that the internal 
servo control loops must run at a much higher digital sampling frequency to be 
able to track the desired coordinate rate time histories. This type of steering 
control is often used in robotics applications where a desired joint time history 
is prescribed, and each joint degree of freedom has a separate control servo 
loop which attempt to track the prescribed coordinate rates. The steering law 
can then be designed such that joint limits and singularities are not approached, 
while leaving the system level dynamics to be compensated for by the rate servo 
loop. 

In rigid body dynamics, the kinetic energy is typically not expressed in 
terms of position coordinate derivatives (i.e. g;’s), but rather in terms of the 
body angular velocity vector w. Therefore, velocity expressions in V for rigid 
bodies will need to be written in terms of w too. As was discussed in the 
chapter on rigid body kinematics, there is a multitude of attitude coordinates 
available to describe rigid body orientations. Convenient Lyapunov functions 
for a selected subset of the attitude coordinates discussed are presented below. 
A popular set of attitude coordinates is the Euler angle vector 8, where 0; could 
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be either the 3-2-1 yaw, pitch and roll angles, the 3-1-3 Euler angles or any other 
set of sequential rotational coordinates. Assume @ measures the current rigid 
body attitude relative to some target orientation, then the candidate Lyapunov 
function 


V(0)= 56"[K|0 (7.51) 


provides a positive definite measure of the attitude error. Using either Eq. (3.56) 
or (3.58) to express 6 = [B(@)|w, the derivative of Eq. (7.51) is expressed as 


V =w? ([B(@)|[K]@) (7.52) 


Contrary to the V in Eq. (7.48), the V in Eq. (7.52) will not lead to a linear 
feedback law in terms of the position/orientation coordinates due to the nonlin- 
ear nature of the [B(@)] matrix. Also, If the target attitude is non-stationary, 
but defined through the reference body angular velocity vector w,, then the 
relative attitude error rate @ is given by 


6 = [B(0)|ow (7.53) 


where @ is the attitude vector from the reference frame to the body frame. The 
corresponding Lyapunov function time derivative is 


V = 6w" ((B(0)][K]6) (7.54) 


For the remainder of this section, unless noted otherwise, it will always be 
assumed that the attitude vector is measured relative to the target state and 
not relative to some inertial frame. Therefore no distinction will be made if this 
reference state is stationary or not since the corresponding angular velocities w 
and dw can be interchanged trivially as shown in Eqs. (7.52) and (7.54). 

The Gibbs or classical Rodrigues parameter vector q is another popular atti- 
tude coordinate vector used to describe large rotations. To establish a feedback 
control law with a fully populated positive definite feedback gain matrix [K], a 
corresponding candidate Lyapunov function is expressed as 


Via) =a [Ka (7.55) 
with the time derivative 
V =u" ((I1— [4] + 49”) [K]q) (7.56) 


If the feedback gain is permitted to be a scalar value K, then V in Eq. (7.56) is 
simplified to 


V=w" (K(1+¢@)4@) (7.57) 


where the notation g? = q’q is used again. Due to the (1 +g?) term, Eq. (7.57) 
leads to a nonlinear feedback control law in q. This nonlinear scaling term can 
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be avoided by choosing a different Lyapunov function as was shown in Ref. 13. 
Instead of using the standard weighted sum square approach to generating an 
attitude Lyapunov function, a logarithmic sum squared approach is used. 


V(q) = Kin (1+ q"q) (7.58) 
Taking the derivative of Eq. (7.58) we find 


2k 


Sar z 
v= Tage qd (7.59) 


which, after substituting the Gibbs vector differential kinematic equation in 
Eq. (3.128), is reduced to the remarkably simply form 
V =w" (Kq) (7.60) 
Using Eq. (7.58), an attitude steering law Lyapunov function can be defined as 
V(q) =In(1+4q"q) (7.61) 
Since the Lyapunov rate equation is given by the compact form 
V=w'lq (7.62) 
the steering law 
w = —|K]q (7.63) 


would asymptotically drive the Gibbs attitude error q to zero if the gain matrix 
[Kc] is positive definite. Once again, to implement this steering law, it is assumed 
that a lower level servo loop is present which would maintain the desired w(t) 
time histories. 

Attitude Lyapunov functions in terms of MRPs are generated in a very 
similar way. For a fully populated feedback gain matrix [K], the Lyapunov 
function 


V(o) = 20" |Klo (7.64) 
can be used to measure the attitude error. Its derivative is of the complex form 
V =u" (((1—-07) I —2[6] + 2007) [K]o) =w" [B(o)|[K]o (7.65) 

If the feedback gain is a scalar K, then V is simplified to 
V =w"? (K(1+07)o) (7.66) 


which will also lead to a nonlinear feedback control law in terms of o. To obtain 
a simpler V with a scalar kK, the Lyapunov function is written as 


V(o) =2KIn(1+0'a) (7.67) 
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Note that by switching the MRP’s to their alternate shadow set whenever 
o? > 1, this Lyapunov function can describe any orientation error without 
encountering a singularity. Further, it provides a bounded measure of the at- 
titude error. This is convenient, since two orientations can only differ by a 
finite rotation. Therefore, having a bounded Lyapunov function describing the 
attitude error inherently reflects this fact and will have some important conse- 
quences when designing attitude feedback control laws in terms of the MRPs. 
After substituting the MRP differential kinematic equations in Eq. (3.150), has 
the simple first time derivative 


V =w! (Ko) (7.68) 


As was shown with the Gibbs vector steering law, the Lyapunov function V(o) = 
2In (1+07c) allows us to show that the MRP steering law 


w=—[K]o (7.69) 


is asymptotically stabilizing. Note however that such steering laws are not 
typically applied to the rigid body attitude problem. Rather, the control law 
is formulated to provide a torque level input and control both the attitude and 
rotational rate. This development will be shown in the following section. 

The most popular redundant, non-singular attitude coordinates are the Eu- 
ler parameters 3;. The zero orientation vector is defined in terms of Euler 
parameters as 


(7.70) 


® 
lI 
SCOOR 


With @ being the orientation vector relative to the desired orientation, we define 
the candidate Lyapunov function V as 


via)=K (6-8) (6-8) (11) 


Using the Euler parameter differential equation in Eq. (3.105), and since B is 
constant, the Lyapunov derivative is given by 


V = Kw™[B(3)]" (6 - 8) (7.72) 


Making use of the identity [B(8)|7@ = 0 in Eq. (3.107), the Lyapunov rate 
expression is reduced to the simple form 


B 
V=Kw? a =w’" (Ke) G43) 
3 


where the e definition in Eq. (3.109) is used. 
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de. wi 
Defining V() = (a - 3) (a _ 8), the steering law 
w= —Ke (7.74) 


leads to the negative semi-definite Lyapunov rate V = —Ke'e. Note that V 
goes to zero whenever € — 0. However, having € = 0 implies that (po is either 
+1 or -1. Thus at first glance it might appear as if the steering law would 
not always reorient the body to the desired orientation. Recalling that having 
80 = +1 represents the same attitude (due to the duality of the Euler parameters 
8 and —8 for the same direction cosine matrix), the steering law in Eq. (7.74) 
will orient the body to the desired attitude. However, it is not guaranteed that 
the steering law will guide the body along the shortest rotational path to the 
desired orientation. 





7.3. Nonlinear Feedback Control Laws 


The elemental Lyapunov functions can be linearly combined to develop veloc- 
ity and/or position feedback control laws for numerous mechanical aerospace 
systems. This section will develop and analyze in detail a reference trajectory 
tracking attitude and angular velocity feedback control law that will stabilize the 
rotation of a rigid body. Any set of attitude coordinates could be used describe 
the rigid body orientation. However, since large and arbitrary rotations must be 
considered, certain coordinates such as the Euler angles are less suited for large 
motion cases. A very popular set of coordinates used when performing large 
rotations are the Euler parameter §;. Since they are nonsingular, a globally 
stable feedback control law in terms of (3; will be able to stabilize a body from 
any attitude error. Instead of using these well known redundant coordinates, 
the feedback control law can be developed in terms of the more recently de- 
veloped modified Rodrigues parameters o;. We will adopt the o;,’s to illustrate 
the process. With only the minimal number of three coordinates, they achieve 
many similar properties as is accomplished with the Euler parameters. While 
the expression of the final feedback control law will depend on which attitude 
coordinates were chosen, the steps taken in the development of this control law 
holds for any choice of attitude coordinates. 


7.3.1 Unconstrained Control Law 


The modified Rodrigues parameter vector o is very well suited for describing 
attitude errors in a feedback control law setting. Particularly when very large 
attitude errors are present, the MRPs are extremely attractive. By switching 
between the original and shadow MRP set they are able to describe any arbitrary 
orientation without encountering singularities by only using three parameters 
instead of four as do the Euler parameters. Adopting the switching surface ¢? = 
1 bounds the attitude error vector norm within the unit sphere |o| < 1 where 
the o-motion is approximately linear with respect to w. This bounded attitude 
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error property is very useful since it will make designing the attitude feedback 
gain much easier. Choosing the o? = 1 switching surface also has a big benefit 
when trying to bring a tumbling rigid body to rest. Conventional attitude 
parameters such as the Euler angles have no explicit means of determining 
the shortest rotational distance back to the reference attitude. Consider this 
one dimensional example. If a rigid body has tumbled past 180° from the 
reference attitude, it would be much simpler for the control law to just assist 
the body in completing the tumble and then bring it to rest as it approaches 
the reference attitude from the opposite direction, as opposed to “unwinding” 
the motion through a rotation of greater than 180°. Using MRPs with the 
o? = 1 switching surface (in a feedback control law setting) provides a set 
of attitude coordinates that will naturally do just that. As is shown in the 
cases in Eq. (3.140), bounding the MRP vector to unit magnitude or less limits 
corresponding principal rotation angle ® to be 180 degrees or less. In other 
words, these MRPs will always measure the shortest rotational error to the 
reference attitude, and control laws seeking to null o will implicitly seek the 
shortest angular path to the target state. Of course the discontinuous switch 
of o? = 1 is a cause for some concern, but these concerns typically turn out to 
have negligible practical consequences. Difficulties may arise if an unusual large 
external disturbance causes cyclic motion through this 180° condition. 

Let [I] be the rigid body inertia matrix, w(t) be the body angular velocity 
vector and u(t) be some unconstrained external torque vector. The vector L is 
some known external torque acting on the body. Euler’s rotational equations of 
motion for a rigid body are given by!4 


[Tw = —[O][T]w + w+ L (7.75) 


The vector a(t) measures the attitude error of this rigid body to some reference 
trajectory which itself is defined through the reference angular velocity vector 
w,(t). The error dw(t) in angular velocities is defined as 


bw = WwW — wW, (7.76) 


The MRP rate vector & and the body angular velocity error vector dw are then 
related through 
Co = 


[(1 — o?)I + 2[6] + 2007] dw (7.77) 


15-17 


QO oBtrR 


Combining Eqs. (7.36) and (7.67) leads to the Lyapunov function 


V(w,a) = 56" [I] + 2K log (1+ 07a) (7.78) 


which provides a positive definite, radially unbounded measure of the rigid body 
state error relative to the reference trajectory. The parameter K is a positive 
scalar attitude feedback gain. Making use of the Lyapunov rates in Eq. (7.34) 
and (7.68), the derivative of the Lyapunov function V is expressed as 

Bq 


V = dw? Ge (dw) + Ka) (7.79) 
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We write the derivative of dw as 8d/dt(dw) to clarify that dw is not treated here 
as a regular vector, but rather as a 3 x 1 matrix of scalar B frame components. 
To guarantee stability we force V to be negative semi-definite by setting it equal 
to 


V = —6w™ [Plow (7.80) 


where [P] is the positive definite angular velocity feedback gain matrix. This 
leads to the following stability constraint. 
Bq 
LE] |, (Ow) + [P]éw + Ko =0 (7.81) 
After making use of the local derivative expression of dw in the B frame given in 
Eq. (7.35) and substituting the rigid body dynamics in Eq. (7.75) into Eq. (7.81), 
the feedback control u is given by 


u=—Ko — [Plow + [I] (w, — [Olw,) + [Oo] [Jw — L (7.82) 


Since the Lyapunov function V in Eq. (7.78) is radially unbounded and the 
MRPs with the o? = 1 switching surface are non-singular, the feedback control 
law u is guaranteed to be globally stabilizing. The cross-coupling term w x 
w, is sometimes neglected in this feedback control law. For typical spacecraft 
maneuvers, both w and w, are relatively small and this cross product is not 
scaled by any inertia components or feedback gains. Therefore this product 
of w and w, usually has a negligible impact on the control law performance. 
However, to rigorously guarantee stability or to include the possibility of large 
w and w,. vectors, this cross-coupling term must be included. 

Note that if the reference trajectory is a stationary attitude (i.e. w,(t) = 
0), then the globally stabilizing feedback control law of Eqs. (7.82) simplifies to 
the elegant (linear in 0, w law:'> 16 


u=-—Ko-—([Plw-L (7.83) 


The last term in Eq. (7.82) is not needed here since for this case this gyroscopic 
term is non working (w7[@][I]w is zero). Note that in either control law in 
Eq. (7.82) or (7.83), whenever the magnitude of the MRP vector o grows larger 
than one and it is mapped to its shadow set inside the unit sphere, the sign 
of the MRP attitude feedback term will change. This corresponds to attitude 
error between the rigid body and the reference trajectory having having grown 
larger than 180°. By switching the MRP vectors, the control law now no longer 
tries to force the rigid body to “unwind” back to the previous path, but rather 
it allows it to complete the revolution and seeks to bring the body to rest 
as it approaches the desired reference trajectory from the opposite direction. 
For a given choice on K and P, we can see in Eq. (7.83) that a large D may 
result in an un-achievable control if u is bounded. As we show below, this 
difficulty is compounded if EZ is unknown. Also note, at the precise instant 
of the switch near o? = 1, the step from Eq. (7.81) to Eq. (7.82) involves 
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substituting for derivatives along assumed continuous trajectories. Unless a 
large L(t) causes the a? = 1 surface to be frequently encountered, no practical 
difficulty is expected due to “chatter”, but pathological problems can obviously 
be invented. Typically switches at o? = 1 are rare events, since o is an attitude 
error expected to be small. 

If we had chosen to use the Euler parameters as our attitude coordinates 
and used elemental Lyapunov function in Eq. (7.71) instead of Eq. (7.67), then 
only the attitude feedback term in our control law would change as follows: 


u = —Ke — [Plow + [I]w, — w x w, + [@][J]w — D (7.84) 


The vector € = (1, G2, 33)" is defined in Eq. (3.109). While both control laws 
in Eq. (7.82) and (7.84) are essentially singularity free, the Euler parameter 
control law control law will not automatically drive the body back to the ref- 
erence trajectory through the shortest rotational path as was the case with the 
combined MRP and shadow-MRP control law. If a body nearly completes a 
full rotation, then the above Euler parameter control law will try to reverse this 
rotation, even though the body is already near the correct attitude. This prob- 
lem can be avoided with a minor modification performed in a similar manner as 
was done with the MRPs. Since the Euler parameters too are non-unique, one 
can always switch the attitude description to the alternate set; in this case the 
transformation would be simply 8’ = —G (or e = —e for the shown Euler pa- 
rameter feedback control law). By ensuring that the current 6; parameters have 
{9 => 0 one is guaranteed that the vectors describes the shortest rotational dis- 
tance back to the reference trajectory. Thus in both cases, a switch at the 180° 
error condition is required to obtain this desired attitude control law property. 


7.3.2 Asymptotic Stability Analysis 


Since V in Eq. (7.80) is only negative semi-definite, it can only be concluded at 
this point that the control law u in Eq. (7.82) is globally stabilizing. To prove 
that it is indeed globally asymptotically stabilizing, the higher time derivatives 
of the Lyapunov function V can be investigated as indicated in Theorem 7.5. 
A sufficient condition to guarantee asymptotic stability is that the first nonzero 
higher-order derivative of V, evaluated on the set of states such that V is zero, 
must be of odd order and be negative definite.°® To simplify the notation 
from here on in this chapter, it understood that the derivative expression dw is 
actually °d/dt(dw,). The same holds true for higher derivatives of dw. For this 


dynamical system V is zero if dw is zero. Differentiating Eq. (7.80) yields 
V =—26w? [Plow (7.85) 


which is zero for the set where dw is zero. Differentiating again the third deriva- 
tive of the Lyapunov function V is 


V = -26w? [P]bc) — 26w7 [Plow (7.86) 
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Substituting Eq. (7.81) into Eq. (7.86) and setting dw = 0, the third derivative 
of the Lyapunov function is expressed as 


V(o,6w = 0) = —K?o" ([J]") [Plo (7.87) 


which is a negative definite quantity since both [J] and [P] are positive definite 
matrices. Therefore the control law u in Eq. (7.82) is globally asymptotically 
stabilizing. 

If some unmodeled external torque AL is present, then Euler’s rotational 
equations of motion are written as 


[Tw = —[a][TJw +u+D+AL (7.88) 


Substituting these equations of motion into the Lyapunov rate expression in 
Eq. (7.79) and keeping the same feedback control law u given in Eq. (7.82) 
leads to the new Lyapunov rate expression 


V = —6w"? [P]éw + dw? AL (7.89) 


For a nonzero AL vector, this V is not negative semi-definite and the control law 
wu is no longer said to be globally stabilizing in the sense of Lyapunov. However, 
for a constant, bounded external torque vector AL, Eq. (7.89) shows that dw 
cannot become unstable and grow unbounded in magnitude. The reason for 
this is that since the expression —dw7[P]éw is negative semi-definite and AL 
is constant, the first term in the V expression is guaranteed to become negative 
and dominant as dw grows in magnitude. As soon as this happens the Lyapunov 
function, which is a measure of the state errors, will decay again and the angular 
velocities will not grow unbounded. The new closed-loop equations of motion 
are written as 


[ow + [Plow + Ko = AL (7.90) 


Taking the derivative of Eq. (7.90) and making use of & = 7[B(o)|éw given in 
Eq. (3.150), we obtain a second order differential equation in terms of dw. 


[I]6c + [P]ow + * [B(o) ou =AL®0 (7.91) 
The last step holds if the unmodeled torque vector is assumed to change very 
slowly with time. Note that this differential equation is of the standard form of 
a damped, spring mass system with a nonlinear spring stiffness matrix K[B(o)] 
if the matrix [B(o)]| can be shown to be positive definite. To do so we verify that 
w?|B(o)|w > 0 for any nonzero angular velocity vector w. Using Eq. (3.150) 
we find 


w" |B(o)|w = w" [(1-07)I + 2[6] +2007] w (7.92) 
= (1—0?)wlw+2(wlo)” >0 (7.93) 
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where the last step holds since the MRP attitude vector is maintained such 
that 0? < 1. Therefore the spring-damper-mass system in Eq. (7.91) is stable 
the angular velocity error vector dw will approach a constant steady-state value 
dW.s5 as time grows large. Taking the limit of Eq. (7.91) we find the steady state 
condition 


K[B(o55)|OWss = 0 (7.94) 


Since [B(o)] was shown to be near-orthogonal in Eq. (3.152), it is always of full 
rank. Therefore the steady-state angular velocity tracking error is 


bw, = 0 (7.95) 


Thus, even in the presence of an unmodeled external torque vector AL, the 
angular velocity tracking errors will decay to zero asymptotically. However, the 
attitude tracking errors will not decay to zero. Taking the limit of Eq. (7.90) 
we find the steady state attitude error to be 
: 1 

Oss = Jim. o= GAL (7.96) 
Without further modification to the control law in Eq. (7.82), the attitude 
tracking errors will settle on a finite offset o,, in the presence of a constant, 
unmodeled external torque. The control law wu is therefore stabilizing in the 
sense of Lagrange, since the state tracking errors are only guaranteed to remain 
bounded. The magnitude of the attitude offset o,, can be controlled with the 
attitude feedback gain K. This steady-state attitude offset is common to PD 
type control laws (Proportional-Derivative) and is not related to the choice 
of attitude coordinates. Had Euler parameters or other attitude coordinates 
been chosen, a similar behavior would have been observed. By using the MRPs 
though it was possible to analytically predict what the o;; will be. This behavior 
can be visualized by considering a mass being suspended by the ceiling by a 
spring with stiffness k. Since a constant gravity force of magnitude mg is 
acting on the mass, the spring must deflect a certain amount before it can 
cancel the gravity force. Including drag effects, the mass will then come to rest 
with the spring stretched a certain distance past its natural, undeformed length. 
By increasing the spring stiffness, this offset is reduced. Analogous behavior is 
evident with the PD control laws derived in Eqs. (7.82) through (7.84). 


Example 7.9: A rigid body with a large initial attitude error is to be brought 
to rest at a zero reference attitude. All three principal inertias are 10 kg- 
m?. The rigid body is initially at rest with an MRP attitude vector o(to) = 
(—0.3, —0.4, 0.2)". The control law used to stabilize the body is of the simple 
PD form 


u=—Ko— Pw 


which was shown to be globally asymptotically stabilizing if no unmodeled 
torques are present. The scalar feedback gains kK and P are chosen to be 
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1 kg-m?/sec? and 3 kg-m?/sec respectively. To illustrate the steady-state 
attitude tracking error produced by this control law, an unmodeled, constant 
external torque vector AL = (0.05, 0, 10, —0.10) Nm is added. This torque is 
chosen to be much larger than what a spacecraft would normally experience 
in orbit due to solar or atmospheric drag, to more clearly illustrate its effect 
and verify the validity of the o,; estimation of Eq. (7.96), even for large 
disturbances. 
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Figure 7.5: Steady-State Attitude Offset Due to Unmodeled External 
Torque Vector 


The resulting maneuver is illustrated in Figure 7.5. As predicted in Eq. (7.95), 
Figure 7.5(i) shows the angular velocity errors decay to zero despite the pres- 
ence of the external torque vector AL. The initial attitude error is reduced by 
the feedback control law w. However, instead of asymptotically approaching 
zero, they settle down at the offset os; predicted in Eq. (7.96) given by 


1 0.05 
Oss = xaL = 0.10 
—0.10 


To reduce this attitude offset o;; in the presence of this large AL vector, the 
attitude feedback gain K would need to be enlarged. This would stiffen up 
the feedback control and may cause the control devices to be more quickly 
saturated; other methods to address steady state offset are available. 


To achieve asymptotic tracking with unmodeled external torques present, 
the control law in Eq. (7.82) is modified by adding an integral feedback term. 
To accomplish this, a new state vector z is introduced.'® 


t 
Hie if (Kor + []éc2) dt (7.97) 
0 
Note that dw is given by Eq. (7.35). If the steady state attitude vector o., is 


non-zero, then the corresponding state vector z would grow without bounds. 
Designing a control law that forces z to remain bounded will implicitly force o 
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to go to zero. To design this feedback control law u, the Lyapunov function in 
Eq. (7.78) is augmented by an additional positive definite quantity in terms of 
the state vector z. 


V(w,0,z) = 5602" [Id + 2K log (1+ o7o) + 521 [Kila (7.98) 


where the positive definite matrix [Az] is the integral feedback gain matrix. 
Taking the derivative of Eq. (7.98) leads to Lyapunov rate expression 


V = (6w + [K7]z)* ([I]ow + Ko) (7.99) 


To ensure stability, V is set equal to the following negative semi-definite expres- 
sion 


V = —(6w + [K7]z)” [P] (Sw + [Ki]z) (7.100) 


where [P] is again the positive definite angular velocity feedback gain matrix. 
Assume at first that no unmodeled external torques are present, then equating 
Egs. (7.99) and (7.100) the closed-loop error dynamics are give by 


[I]dw + [Plow + Ko + [P][Kr]z = 0 (7.101) 


Substituting Eq. (7.35) and the rotational equations of motion in Eq. (7.75) into 
Eq. (7.101) leads to the following feedback control law wu. 


u=—Ko — [Pow — [P][Kr]z + [I] (w, — [@]w,) + [@|[ZJw —L (7.102) 


While the definition of the internal error state vector z in Eq. (7.97) is conve- 
nient for control analysis purposes, it is not very convenient to implement. In 
particular the term [I]é6w could cause problems since it requires angular accel- 
eration information. Since the inertia matrix of a rigid body [J] is constant, the 
z vector can also be written in the useful form 


x(t) =K f FRANIGR= 520) (7.103) 


where dwg is the initial body angular velocity error vector. Using this z vector 
expression, the control law w is expressed as 


u = —Ko — ([P] +[PI[Ki][I]) dw — K[PI[Ky] | oat 


[PI[K][]50o + [Z| (&, — []w,) + [][Z]Jw —L (7.104) 


The integral feedback gain matrix [K,] is typically kept small in size relative 
to the angular velocity feedback gain matrix [P]. The integral feedback term 
is only added to rid the closed-loop dynamics of any non-zero steady-state at- 
titude vectors. It is not desirable for this integral feedback term to drastically 
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change the closed loop response behavior. As is evident in Eq. (7.104), a rela- 
tively large [Ky] would change the effective closed loop frequency and damping 
characteristics in a substantial manner. 

Since V in Eq. (7.100) is negative semi-definite, all the states w, o and z are 
Lyapunov stable. Further, Eq. (7.100) shows that the quantity 6w+[K7]z will go 
to zero. To investigate if the states are asymptotically stable without unmodeled 
external torques present, the higher order derivatives of V are investigated on 
the set where dw + [K,;|z = 0. The second derivative is clearly zero on this set. 
The third derivative, evaluated on this set, can be shown to be 


V(o,6w + [K7]z = 0) = —K?o7 ([IJ~*) [Pl [Jo (7.105) 


which is a negative definite quantity. Therefore the attitude error vector o is 
guaranteed to decay to zero. Due to the kinematic relationship between o and 
dw, if o goes to zero over time, then so must dw. Since Eq. (7.100) shows that 
the quantity dw + [K7]z goes to zero, then so must the state vector z. Thus, 
in the absence of unmodeled external torques, adding the integral term to the 
feedback control law did not change the asymptotic stability property. 

If an unmodeled external torque AL is included in the dynamical system 
by substituting Eq. (7.88) into Eq. (7.99), using the feedback control law u in 
Eq. (7.102) then leads to the following Lyapunov rate expression. 


V =— (dw + [K7]z)" ([P] (6w + [Ky]z) — AL) (7.106) 


For a non-zero AL, this V is not negative semi-definite and stability of the 
states dw, o and z is not guaranteed. However, for a bounded AL Eq. (7.106) 
does show that dw and z cannot grow unbounded, since for sufficiently large 
dw and z the term 


— (6w + [K7]z)" [P] (Sw + [K7]z) 


will dominate and the Lyapunov rate V is guaranteed to become negative. For 
the state z to converge to a finite value as time grows to infinite, then both o 
and w must decay to zero. If o would converge to a non-zero vector, then the 
integral expression in either Eq. (7.97) or (7.103) would grow to infinity. Since 
o — 0, then due to their kinematic relationship so must dw — 0. Therefore 
both and dw are asymptotically stable. The question that remains is what 
happens to the state vector z if AZ is non-zero. Just because z must remain 
bounded, we cannot conclude that it also must go to zero. For the V expression 
in Eq. (7.106) to approach V =0, the following limit must be true. 


lim ([P] (Sw + [Ky]z) — AL) = 0 (7.107) 


—> CO 


Since dw — 0, then 


lim z= [K7]“*[]“'AL (7.108) 


t—oo 
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This agrees with our earlier stability analysis which stated if AD is zero, then 
z would go to zero. The closed-loop equations of motion for this system are 
written as 


[I]ow + [Plow + Ko = AL — [P|[Ky]z (7.109) 


Therefore, as [P][K,r]z — AL as shown in Eq. (7.108), then the integral feed- 
back term in time will effectively cancel the external torque disturbance. Once 
this happens the closed-loop dynamics are the same as Eq. (7.101) where no 
unmodeled external torques were present. 


Example 7.10: The simulation in Example (7.9) is repeated here with the in- 
tegral feedback term added to the control law. The initial attitude error is the 
same as before, but the initial angular velocity error is w(to) = (0.2, 0.2, 0.2) 
rad/sec. Since all three principal inertias are set to be equal, then we can use 
the short-hand notation I = 10 kg-m?. The feedback control law used is 


t 
u=—Ko— (Olll}w -— PU+ Kiw- PRK | odt + PKrIw(to) 
0 


The scalar integral feedback gain Ky; was set to 0.01 sec™’. Having the 


additional integral feedback term should make os; go to zero. Further, since 
AL is a non-zero vector for this simulation, the state vector z is expected to 
approach the finite limit 


1 1.66 
jim Z= rl =| 3.33 | kg-m?/sec 
- —3.33 


The resulting maneuver is illustrated in Figure 7.6. Figures 7.6(i) and 7.6(ii) 
clearly show that the state errors w and o& indeed both decay to zero. The con- 
trol torque vector components are shown Figure 7.6(iii). Since the feedback 
control law uw has to compensate for the external disturbance, its components 
remain non-zero at the maneuver end. The state vector z is shown in Fig- 
ure 7.6(iv). As indicated in Eqs. (7.108) and (7.109), the z vector does not 
decay to zero. Rather, it asymptotically approaches the prescribed values to 
cancel the influence the external torque disturbance. 


Another method to reduce the tracking error os; would be to adaptively 
learn the external torque vector by comparing the predicted Lyapunov decay 
rate to the actual decay rate as shown in Ref. 19. This method has been found 
to yield a very simple adaptive law that is also able to compensate for inertia 
matrix modeling errors as well as external torque vectors. 


7.3.3. Feedback Gain Selection 


To determine appropriate feedback gains, the closed loop dynamics are studied. 
Substituting the feedback control law u given in Eq. (7.82) into Eq. (7.75) 
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Figure 7.6: Integral Feedback Control Law Simulation with Unmodeled 
External Torque Vector 


the closed loop dynamics for the controlled rigid body in the absence of any 
unmodeled external torques are’” 


[T]ow = —[P]dw — Ko (7.110) 


Note that due to the use of the MRPs and the logarithm function in Eq. (7.78), 
the closed loop tracking dynamics are rigorously linear in both the body angu- 
lar velocity and attitude error vectors, even though large general motions are 
considered. Eq. (7.110) is solved along with the differential kinematic equa- 
tion expressed in Eq. (3.150) to determine the exact closed-loop performance. 
The only nonlinearities that appear in these two differential equations are the 
quadratic nonlinearities present in the MRP kinematic differential equation. 
Linearizations are attractive in order to impose terminal motion control law 
design criteria. Linearizing Eq. (3.150) about o= 0 yields 

ee 7.111 

oa (7.111) 
Since the MRPs “behave like angles over four” for small angles, this linearization 
will be applicable for a relatively large range of rotations. As a comparison, the 
classical Rodrigues parameters only linearize as angles over two, whereas the 
standard Euler angles simply linearize as angle type quantities. 
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The linearized set of closed loop equations are given by 


(13) : Lin “tr (2) (7.112) 


Given the rigid body inertia matrix [J], any standard linear control design 
method such as a pole placement method can be used to determine the de- 
sired response of the linearized closed loop dynamics. If both the inertia matrix 
[Z] and the angular velocity feedback gain matrix [P] are diagonal matrices with 
entries I; and P; respectively, then Eq. (7.112) can be conveniently decoupled 
into three sets of differential equations!* 1” 


/ 1 . 
i) |e 4] ) 1=1,2,3 (7.113) 
? I; Tj 4 


whose roots are explicitly given by 


1 
M=—5p (?, + /-Kn+Pe) i=1,2,3 (7.114) 


For an underdamped system, the corresponding closed loop natural frequencies 
Wn, and damping ratios €; are 





1 
np = —1/ KI, —2P? 7.115 
ne = 57 (7.115) 


en eee (7.116) 


VKI; — 2P? 


The decay time constants T; which indicates how long it would take for the state 
errors to decay to 4 of their respective initial values are given by 


2h 


T; 
P; 


(7.117) 
It is interesting to note that only the angular velocity feedback gain constants P; 
dictate how fast the state errors will decay. The attitude feedback gain constant 
kK contributes to both the natural frequency and damping ratios of the closed 
loop response. The damped natural frequency wg, is given by 


Al 
1 Oe 


KI, — P? (7.118) 
This enables an explicit “pole placement” design process in which (K, P;) can 
be chosen to achieve specific desired (wg,,T;) or (wa,,&:) characteristics for the 
closed loop system. The use of the feedback control law in Eq. (7.82), along 
with the design of the feedback gains, is illustrated in the following numerical 
simulation. 
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Example 7.11: Assume a rigid body with body axes aligned along the prin- 
cipal axes is initially in a tumbling situation. The reference trajectory is set 
to be the zero attitude at rest. The parameter values for the numerical sim- 
ulation are shown in Table 7.11. The relative orientation of the rigid body 
to the zero attitude is expressed through the MRP vector o. Note that 
the rigid body has a large initial angular velocity about the first body axis 
which will cause the body to tumble through the ® = 180 degree orien- 
tation. Other three-parameter sets of attitude coordinates cannot describe 
arbitrary rotations without encountering singularities. For example, had the 
classical Rodrigues parameters been used in the simulation they would early 
on encounter a singularity at 6 = 180 degrees. 


Table 7.2: Parameter of MRP Control Law Numerical Simulation 


Parameter Value Units 
hh 140.0 kg-m 
Ip 100.0 kg-m? 
Is 80.0 kg-m? 


a(to) [0.60 — 0.40 0.20] 

w(to) [0.70 0.20 —0.15] rad/sec 
[P] [18.67 2.67 10.67] kg-m?/sec 
K 7.11 kg-m?/sec? 


The feedback gains for this simulation were chosen such that the closed loop 
dynamics will be very underdamped. Clearly the resulting performance would 
not be what is needed to control a real system. However, having visible state 
oscillations present will allow for the predicted damped natural frequency in 
Eq. (7.118) and decay time constants in Eq. (7.117) to be verified. 


The results of the numerical simulation are shown in Figure 7.7. The control 
vector u stabilizes the tumbling rigid body and brings it to rest at the zero 
attitude. The decay time constant 72, which controls how fast the states 
os and ws are reduced, was chosen purposely to be much larger than the 
other two time constants. This results in the second body axis state errors 
being reduced much slower than the other two, simulating a situation where 
less control authority is present about this axis. As is seen in Figures 7.7(i) 
and 7.7(ii) the nonlinear response corresponds very well with the linearized 
prediction. As the body tumbles through the “upside down” orientation at 
®= 180°, the MRP vector switches automatically near 72 = 1 to the alternate 
set. At this point the corresponding control law ceases to fight the tumble 
and lets the body complete the revolution before bringing it to rest at the 
origin as seen in Figure 7.7(iii). 


Let vector € be the state error vector whose components are given by 


6G =Vo?+w? i=1,2,3 (7.119) 


To study the damped natural frequencies wa, and the decay times J; the 
natural logarithm of e; is plotted in Figure 7.7(iv). This Figure clearly shows 
the decay rate and the natural oscillations of the underdamped response. 
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Figure 7.7: MRP Feedback Control Law Simulation Without Control 
Constraints 


Note that the simulated maneuver performs a very large rotation which in- 
cludes a complete tumble. Typically, when studying the closed loop response 
of a control law, only small attitude errors in the order of 10s of degrees are 
used. Table 7.3 compares the actual averaged decay rates and damped natu- 
ral frequencies of the nonlinear system to the ones predicted by the linearized 
feedback gain design. As expected, the linearization used in Eq. (7.111) 
yields accurate closed loop performance predictions because of the extremely 
large domain in which the exact o-motion is near linear. The percent differ- 
ences between the actual nonlinear JT; and wag, and the ones obtained from 
the linearized model are only in the 1 to 2 percent range. Thus the MRP 
feedback law in Eq. (7.82) achieves predictable, global, asymptotic stabil- 
ity by only using three attitude coordinates as compared to four coordinates 
required by Euler parameter feedback laws. Some control laws using other 
three parameter sets of attitude coordinates such as the standard yaw, pitch 
and roll angles also claim to have global stability. However, they all come 
with a disclaimer warning against rotating the rigid body to certain attitudes 
because of the inherent singularities of the chosen attitude coordinates. Such 
control laws can therefore hardly be considered globally stabilizing. The MRP 
attitude description allows for arbitrary rotations and has the added benefit 
of always indicating the shortest rotational distance back to the origin when 
the switching surface 0? = 1 is chosen. There is one caveat for bounded 
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Table 7.3: Comparison of Actual Averaged Closed-Loop Response Pa- 
rameters vs. Predicted Linearized Values 


Parameter Actual Average Predicted Value Percent Difference 


Ti 14.71 s 15.00 s 1.97% 
T2 76.92 s 75.00 s -2.50% 
T3 14.71 s 15.00 s 1.97% 
Way 0.0938 rad/s 0.0909 rad/s -3.12% 
Wd» 0.1326 rad/s 0.1326 rad/s 0.08% 
Was 0.1343 rad/s 0.1333 rad/s -0.74% 


controls: large unknown disturbances which cause cyclic passage through the 
180° error condition could cause a problem with control chatter. 


7.4 Lyapunov Optimal Control Laws 


The feedback control laws in Eqs. (7.82) and (7.104) were developed assum- 
ing that no control magnitude constraints are present. However, most control 
devices such as reaction wheels, CMGs or thrusters have an upper bound on 
how much control authority they can exert onto a system. If a control device is 
operating at such a bound, it is said to be saturated. This section investigates 
the stability of dynamical systems with saturated control present. 

There are essentially two possibilities for dealing with saturated controls. 
One solution is to reduce the feedback gains such that the anticipated required 
control effort never saturates any control devices. This is typically done when 
designing open-loop reference trajectories. However, this method has the draw- 
back that the overall performance of the feedback control law is greatly reduced, 
perhaps to an un-acceptable degree. When trying to stabilize a system about a 
reference state, a more efficient method of dealing with saturated controls is to 
allow individual control devices to become saturated. This leads to a saturated 
control law which is said to be Lyapunov optimal. Being Lyapunov optimal 
means that the time derivative of the given Lyapunov function V is made as 
negative as possible during intervals where one or more of the control devices 
are saturated.® 2° ?! However, certain difficulties, including possible loss of con- 
trollability, are potentially implicit in this approach if the most negative V is 
still positive! 

The goal of the controller design process is to choose a control law from an 
admissible set that will stabilize the system in an optimal fashion (i.e. make V 
as negative as possible). For saturated controls of a natural system, the classical 
stabilizing controller takes the form 


Qi = —Qimaz 894) (7.120) 


where Q, are the generalized control forces, q; are the derivatives of the general- 
ized coordinates and Qj;,,,,, are the control bounds. This control law is Lyapunov 
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optimal for minimizing the performance index J 


J=V=)~4Qi (7.121) 


i=l 


The control law is optimal in a sense analogous to Pontryagin’s Principle for opti- 
mal control because the controls are selected from an admissible set |Q:| < Qinas 
such that the instantaneous work rate (in the common event that V has an en- 
ergy interpretation) is minimized at every point in time. Note that mathemati- 
cal difficulties and practical system performance issues arise if this controller is 
implemented directly for most systems.?? The discontinuity at the origin must 
typically be replaced with a region of unsaturated control to avoid chattering 
near q; = 0. This unsaturated controller can either approximate the disconti- 
nuity or be some other stable/optimal feedback controller that transitions from 
the saturated controller on the saturation boundary. We restrict attention here 
to control laws that transition continuously at the saturation boundary. The 
obvious choice is to augment Eq. (7.120) with a linear controller of the type 


—Kid for |Kigi| < Q: 
a={ q or |Kidil < Qinas (7.122) 


| -Qimax 894i) for |Kidil > Qiman 


where K; > 0 is a chosen feedback gain. This control continuously transitions 
across the saturation boundary and eliminates chattering. Note that Eq. (7.122) 
allows some elements of the control vector to become saturated, while others are 
still in the unsaturated range. This differs from conventional gain scheduling 
and deadband methods which typically reduce the feedback gains to keep all 
controls in the unsaturated range. 


Example 7.12: Let us design a saturated control law for a single degree 
of freedom nonlinear oscillator. Assuming m,c,k,kn > 0, the equation of 
motion of a Duffing oscillator are given by 


mé+ ce + ke +kna® =u 
The Lyapunov function (the system Hamiltonian of the unforced and un- 


damped system) is 


whee Te ee el 4 
V= gms + 5ke + gkwa 


V is positive definite and vanishes only at the origin, which is the only real 
equilibrium point of the un-forced system. The performance index is the time 
derivative of V and can be written immediately from Eq. (7.43) as 


J=V =4Q =4(-cé+u) 


For bounded control |u| < umaz, the performance index J is minimized by 
the feedback controller 


U = —Umaasgn(«) 
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Using this control law, V is reduced to the energy dissipation rate 

V(a, ) = —ch? — Umard * sgn(x) 

It is of interest to note that an arbitrary, unknown, positive definite potential 
energy function AV (a) could be added to V — and exactly the same result 
is obtained for V and wu. Thus the structure of the control law and the 
stability guarantee is invariant (and therefore inherently robust) with respect 
to a large family of modeling assumptions. 

Since V (a, x) is negative semi-definite, it can only be concluded at this point 
that the system has globally stable motion near the origin; thus x and & will 
remain bounded. Since the control u is bounded by definition, the duffing 
oscillator equations of motion show that % will also be bounded. To prove 
asymptotic stability, the higher derivatives of V must be investigated. The 
only point where V vanishes is = 0. The second derivative of V is 


eV 
—- = —2cL4X — Umartisgn(s£ 
which is also zero for all 2 when « = 0. The third derivative of V is 
abv 2 da Bx 
— = —2cxr* — 2cr— — max ~ sgn(a 
dt? eee (2) 
Using the duffing oscillator equations of motion, we find on the set where 
xz = 0 that 
BV c 3\2 
—= = —-2—(ka+knx 
dt? et mat N ) 


which is a negative definite function of x. Therefore, according to Theo- 
rem 7.5, the saturated control law wu is globally asymptotically stabilizing. 


If a tracking control law is subjected to control constraints, then Lyapunov 
optimality is difficult to define because tracking stability cannot be guaranteed 
during saturated control intervals. Nevertheless, globally asymptotically stable 
tracking controllers can often be achieved by generalizing the method devel- 
oped in this section. A generalized work/energy equation that is equivalent to 
Eq. (7.43) is not possible because the position and/or attitude error tracking 
coordinates are measured in a non-inertial reference frame (thus a more tedious 
process is required to establish the V equation for each system. Also, consid- 
eration must be given to whether the prescribed trajectory is a feasible exact 
trajectory of the system. 

Consider the case of having a rigid body track a given reference trajectory 
w,(t). The unsaturated control law uy, given by 


tus = —Ko — [P]5u + [I] (dr — [wy) + [@] [Jw — L (7.123) 


has been shown to be globally, asymptotically stabilizing. The corresponding 
Lyapunov rate function V can be expressed as 


V = bw! (-[@][TJw + u— [I] (W, — [@]w,) + Ko) (7.124) 
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Assume that the available control torque about the +th body axis is limited by 
Umaz,;- Then following earlier analysis, we augment the unsaturated control law 
Uus With a Lyapunov optimal saturated term to yield a modified control law wu. 


this: for |tus; 
Ui= 


Uus; SgN(Uus,) for |tus, 





< Umax; 


(7.125) 





> Umax; 


A conservative stability boundary (a sufficient condition for stability) for this 
modified control torque wu is found to be 


| (UT) (@r — lw.) + [ol[T]w — Ko), | < tmas: (7.126) 


Note that, for this higher dimensional system, this stability constraint may 
be overly conservative. The condition in Eq. (7.126) is clearly violated if the 
inequality fails about any one body axis. 

Let us now consider the problem of a tumbling rigid body where the controls 
are saturated. In such a case tracking a reference trajectory is no longer a 
primary concern, rather stabilizing the motion is. Therefore w,-(£) is set to zero. 
This allows V of Eq. (7.124) to be simplified, using w7 [a], to 


V =u" (u+ Ko) (7.127) 
The control torque u,,; for unsaturated conditions is then reduced to 
Uus = —Ko — [Plw (7.128) 
A conservative stability condition is found by studying V in Eq. (7.127): 
K\o;| < Umar; (7.129) 


Since the magnitude of the MRP attitude error vector o is bounded by 1, this 
stability condition can also be written as 


IS tie ss (7.130) 


As shown in Ref. 9, while this condition in Eq. (7.129) guarantees stability, it it 
not a necessary condition for stability. If one simply wanted to stop the tumbling 
motion without regard to the final attitude, then one could set K = 0. Assume 
that the velocity feedback gain matrix [P] is diagonal. Then the saturated 
control law wu is 


— Pw; for |Piiwi| < Umax; 
uy = s oF | Fests S Uae (7.131) 
—Umax;* $gn(w;) for |Pyw;| > Umaz: 
which leads to the Lyapunov rate function 
M N 
Vw) =- >> Paw? — S> wi- sgn(wi) (7.132) 
i=1 i=M+1 
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where M is the number of unsaturated control inputs currently present. Since 
this V is negative definite (we only care in this case about w, not about atti- 
tude), the combined saturated, unsaturated control law in Eq. (7.131) is globally 
asymptotically stabilizing. 

Limiting K through the stability condition in Eq. (7.130) is usually overly 
conservative. As the numerical simulation in Example 7.13 will illustrate, hav- 
ing a K > Umaz, Still typically leads to an asymptotically stable closed-loop 
dynamics. The reason for this is the bounded nature of the attitude error 
vector. The stability condition in Eq. (7.129), and therefore the requirement 
of V being negative, may indeed be locally violated for finite periods of time. 
These violations are likely to occur whenever the rigid body tumbles towards the 

= +180 degrees condition. After the body tumbles past 6 = +180 degrees, 
the sign of attitude vector components are switched through o* = —c. As is 
seen in Figure 7.7(iii), the required unsaturated control torque drops drastically 
in magnitude during this switching. Before the switching, where the body is 
still rotating away from the origin, both the angular velocity and the attitude 
feedback are demanding a control torque in the same direction and their effects 
are added up to produce the large control torque before the switching. After 
the switching at the 7? = 1 surface, the body now starts to rotate back towards 
the origin and the sign of the attitude feedback control is switched. This results 
in the angular velocity and attitude feedback control partially cancelling each 
other and therefore producing a much smaller control torque. Therefore the 
required control torques are larger and more likely to be saturated approaching 
® = +180 degrees then they are leaving the “upside-down orientation.” Since 
the body is tumbling, the o vector magnitude will always periodically come 
close to zero where the stability condition in Eq. (7.129) is satisfied and kinetic 
energy is guaranteed to be pumped out of the system because we guarantee 
in Eq. (7.132) that V <0. Eventually, perhaps after several revolutions or 
tumbles, the body will come to rest. 











Example 7.13: The rigid body detumbling maneuver in Example 7.11 is 
repeated here in the presence of control constraints tmaz, = 1 Nm. The 
unsaturated control law 


u=—Ko —[Plw (7.133) 


is augmented with a saturated control law as shown in Eq. (7.125). The 
numerical simulation results are shown in Figure 7.8. 


As Figure 7.8(i) shows, with the limited control effort present the rigid body 
now performs about five tumbles before coming to rest at the origin. The 
large initial body angular velocity about the first body axis is gradually reduced 
until the control torque uw remains in the unsaturated regime. As shown in 
Figure 7.8(ii), from there on w} starts to exhibit the anticipated underdamped 
oscillations as were present with the unsaturated control law. For the first 
100 seconds into the simulation, the control torque components u; remain 
mostly saturated as shown in Figure 7.8(iii). Once the angular velocity errors 
are sufficiently reduced, the required control effort remains in the unsaturated 
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Figure 7.8: Saturated MRP Feedback Control Law Simulation 


regime. Figure 7.8(iv) shows the MRP attitude vector components for up to 
120 seconds into the simulation. In the background the time regions are 
grayed out where the Lyapunov function time derivative V is actually positive 
for this dynamical system. As predicted, V_ becomes temporarily positive 
when the rigid body is rotating towards the “upside-down” orientation. As 
soon as the body rotates past this orientation V becomes negative again. This 
happens even though the control torque vector components u; are mostly still 
saturated. 


Therefore, even though K was chosen to be much larger than Umax; = 1 for 
this simulation, the saturated control law in Eq. (7.125) still asymptotically 
stabilized the rigid body. Thus, one beautiful property of this MRP feedback 
control law is that not only does it perform well for small orientation errors, it 
also scales well to handle the much tougher problem of controlling arbitrary 
large tumbling motions in the presence of control saturation. 
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7.5 Linear Closed-Loop Dynamics 


Whereas the previous attitude feedback control laws were found by first defining 
a candidate Lyapunov function and then extracting the corresponding stabiliz- 
ing control, it it also possible to start out instead with a desired (or prescribed) 
set of stable closed-loop dynamics and then extract the corresponding feedback 
control law using a variation of the “inverse dynamics” approach common in 
robotics open-loop path planning problems. This technique is very general and 
can be applied to a multitude of systems. Paielli and Bach present such a con- 
trol law derived in terms of the Euler parameter components in Ref. 23. Let 
the € = (31, G2, G3)" be the vector portion of the Euler parameters as defined in 
Eq. (3.109). Note that € contains information about both the principal rotation 
axis and principal rotation angle. Therefore, if € — 0, then the body has rotated 
back to the origin. Let’s assume that we desire the closed loop dynamics to have 
the following prescribed linear form 


é+Pé+Ke=0 (7.134) 


where P and K are the positive scalar velocity and position feedback gains. 
From linear control theory it is evident that for any initial € and € vectors, the 
resulting motion would obviously be asymptotically stable. If desired, one could 
also easily add an integral feedback term to the desired closed loop equations. 


t 
e+ pe+Ke+ ki | edt = 0 (7.135) 
0 


With judicious choices for P, K and K;, stable e(t) motions can be specified by 
Eq. (7.135). Note that instead of the Euler parameter vector component €, any 
attitude or position vector could have been used. Next we will impose kinematic 
and dynamical differential constraints to find the control law that will render 
the closed loop dynamics of a rigid body equal to Eq. (7.134). Through Euler’s 
rotational equation of motion 


[I]w + [eo] [I]w =u (7.136) 


once the body angular acceleration vector w is found consistent with Eq. (7.134) 
or (7.135), then the control law vector wu is also given. To find an expression for 
w, we need to differentiate the Euler parameter kinematic differential equation. 
Assuming the target state has zero angular velocity, from Eq. (3.104) the vector 
€ is expressed as 


é= =|Tlw (7.137) 
where the matrix [T] = [T'(3o, €)] is given by 
Bo -=83- Be 


[T]=| 6s 60 i) = Golsxa + [€ (7.138) 
—B2 fi Bo 
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The term (4p is also expressed from Eq. (3.104) as 


1 
Bo = —56 (7.139) 
Differentiating the differential kinematic equation in Eq. (7.137) we find 
wn aie Le De 


Using Eq. (7.138) the term [T]w is expressed as 
[T]w = Bow — [a]é (7.141) 


Substituting this [T]w and making use of Eqs. (7.137) and (7.139), the vector € 
is written as 


1 1 
é= site aa (e* ww + [@][T]w) (7.142) 
This expression can be further simplified by substituting Eq. (7.138) and using 
the identities [aja = 0 and 


T 


[al[a] = aa? — a" alsxs (7.143) 


Using these Eq. (7.142) is written in its most compact form 


1 1 
é= 5 [Te — qe (7.144) 
where the shorthand notation w? = w?w is used. Eq. (7.144) introduces 


the necessary w term which leads to the control vector u. After substitut- 
ing Eqs. (7.137) and (7.144) into our desired linear closed loop dynamics of 
Eq. (7.134), the following constraint equation can be found. 


1 
(T] (« Pet (F\= (~5.%e 2 2Ke) ) =0 (7.145) 
The matrix inverse of [T] can be written explicitly as 
1 
(TA Sir + ame (7.146) 
0 


This expression can be readily verified by using it to confirm [T]~*[T] = Isx3. 
From Eq. (7.146) it is evident that the matrix inverse of [T] is always possible 
except when 39 — 0. This corresponds to the rigid body being rotated + 180 
degrees relative to the target state at € = 0. Since [T] is of full rank everywhere 
with the exception when 39 = 0, other than at this particular orientation, from 
Eq. (7.145) the following acceleration constraint must hold to achieve the desired 
tracking dynamics of Eq. (7.134): 





i 
w+ Pw + [T]~* (~5%e + 2Ke) =0 (7.147) 
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Substituting Eq. (7.138) and (7.146), the body angular acceleration vector w is 
expressed as 


=) € 
w=—Pw—2(k—-—]— 7.148 
( 4} fo ( ) 
After substituting this desired (or required) acceleration w into Euler’s rota- 
tional equations of motion, we can solve for the required nonlinear feedback 
control law vector u as 

2 


u = [a] [I]w + [I] (-Ps a (« S =) =) (7.149) 
4} Bo 

Note that since the vector q = €//39 is the Gibbs vector, this control law is alter- 
natively written as a function of (q, w) and is singular near principal rotations of 
+ 180 degrees. Therefore this control law is not globally stabilizing despite the 
linear closed loop dynamics (motions which tumble through +180 degrees are 
excluded). It is interesting to compare this control law with the Gibbs vector 
control law previously derived from a Lyapunov function. Using the Lyapunov 
functions in Eq. (7.29) and (7.58) leads to the asymptotically stabilizing control 
law 








u = [a|[I]Jw — Pw — Kq (7.150) 


The reason the control law in Eq. (7.150) does not lead to linear closed loop 
dynamical equations is because of the quadratic nonlinearity present in the 
Gibbs vector differential kinematic equations. However, this nonlinearity is 
very weak for a large range of rotations and we and [®][I]w can typically be 
ignored when designing the feedback gains. Only if it is necessary to precisely 
predict the closed loop behavior with linear control theory is it advantageous to 
add the more complex w and q feedback in Eq. (7.149). We remark that it is 
possible to parallel the above developments using the MRP vector o instead of 
e (or q), and eliminate the singularity at +180 degrees, and still have a linear 
tracking error dynamics. This is evident in Example 7.14 below. 

An attractive part of this methodology is that the structure of the closed loop 
equations can easily be modified using standard linear control theory techniques. 
It is also of paramount importance that this methodology has been generalized 
with adaptive control methods to obtain even more robust version of these 
feedback control laws.?* ?° If it is necessary that the feedback control reject 
external disturbances, an integral measure of the attitude error is added to the 
closed loop equations as shown in Eq. (7.135). Following similar steps as were 
done previously in this section, the desired body angular acceleration vector w 
which results in an integral feedback control law is then written as 


Y w2\ € T 1 of y 

w=—Pw—2| kK -— })—— 2K; | [T)’ + —ee edt (7.151) 
4 Bo Bo 0 

Where the integral feedback term in the Lyapunov function derived control law 

in Eq. (7.104) has a constant feedback gain, the integral feedback of € is scaled 

by a nonlinear term. 
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If the target state angular velocity vector w, is non-zero, then the e differ- 
ential kinematic equation is written as 
. il 
é= gl Flow (7.152) 
where the vector dw is the error vector in body angular velocities defined as 
0W = W— WwW, (7.153) 


The error angular acceleration vector is found be taking the inertial derivative 
of Eq. (7.153). 


Ji) = W — Ww, (7.154) 


Note that here dw is treated as a vector, not asa 3x1 matrix. Therefore this dw 
expression is different then the local derivative expression in Eq. (7.35) used in 
deriving the Lyapunov feedback control laws. After differentiating Eq. (7.152) 
the vector € is found. 

belek pie eee 

é= gl Flow + gl tle (7.155) 
Substituting these € and € expressions into the linear closed loop dynamics in 
Eq. (7.134), and making use of Eq. (7.154), the body angular acceleration vector 
w is found to be 


bw ) € 
w=w,— Pbw —2 | kK — — } — 7.156 
( 4 / Bo ( 
The w in Eq. (7.151) which leads to an integral feedback control law can be 
modified in a similar manner to track a reference rotation w,(t). 


Example 7.14: Instead of using the Euler parameter vector e€ as the attitude 
measure, this example will use the MRP vector o. Assume that the closed 
loop attitude error dynamics are desired to be of the stable second order form 


o+Poa+Ko=0 


where P and K are positive scalar feedback gains. The kinematic differential 
equation of the modified Rodrigues parameters is expressed as 


where the matrix [B] is defined in Eq. (3.150). To introduce the w term, 
the time derivative of this kinematic equation is taken to produce the exact 
relation 


z 1 ’ 1.- 
o= qiBle + ql Ble 
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Substituting the expressions for @ and o& into the desired linear closed loop 
dynamical equations, the following constraint condition is found. 


eiPaa Ke 7B] (o+ Pot [BJ ([Blw +4Ke)) =0 


Since for |o| < 1 the matrix [B] is always invertible, then the constraint on 
w is 
w+ Pw +[B]- ((Blw + 1Ko) =0 


Using the vector product definition of the [B] matrix in Eq. (3.150), the 
matrix product [B]w is expressed as 


[Blw = (207 (1- a”) w—(1+ a”) wa —4o wlolo +4 (ow) a) 


Using this expression along with the analytic inverse of matrix [B] given in 
Eq. (3.152) as 


=P 


[B] = G40" 


allows the body angular acceleration vector w constraint to be reduced to the 
remarkably simple form 


2 
G2 Pis= (ow Me (4 “2 =) Inxs) o (7.157) 





This MRP feedback control is only slightly more complicated than the angular 
acceleration associated with the Gibbs vector control in Eq. (7.148). How- 
ever, since whenever a” > 1 the MRPs are switched to their corresponding 
shadow set, this w yields a globally, asymptotically stable feedback control 
law, whereas Eq. (7.148) is singular at +180 degree rotations about any axis. 





Table 7.4: Linear MRP Closed Loop Dynamics Numerical Simulation 


Parameters 
Parameter Value Units 
qh 30.0 kg-m” 
In 20.0 kg-m? 
Is 10.0 kg-m? 
a(to) [—0.30 — 0.40 0.20] 
w(to) (0.20 0.20 0.20] rad/sec 
[P] 3.0 ke-m?/sec 
K 1.0 kg-m?/sec? 


The following numerical example illustrates the linear closed loop dynamics 
of this nonlinear feedback control law. The simulation parameters are shown 
in Table 7.4 and the resulting reorientation is shown in Figure 7.9. No ex- 
ternal disturbances were included in this simulation. Figure 7.9(i) shows the 
MRP attitude vector o components. Their behavior can easily be verified by 
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Figure 7.9: Linear Closed-Loop Dynamics using the MRP Vector 


solving the linear differential equation 6 + Pa + Ko = 0 for the given initial 
conditions. Figure 7.9(ii) shows the corresponding nonlinear control w. 


7.6 Reaction Wheel Control Devices 


Instead of using propellant expelling thrusters, often spacecraft rotational ma- 
neuvers are performed using some type of momentum exchange devices. The 
two most common such devices are the Reaction Wheels (RWs) and the Con- 
trol Moment Gyroscopes (CMGs). Both are electrically powered and are thus 
well suited for long-duration missions. Reaction wheels are body fixed disks 
which are spun up or down to exert a torque onto the spacecraft. They have 
a relatively simple construction and are cheaper to produce than CMGs. How- 
ever, their torque output is rather small compared to the torque output of a 
single-axis CMG. 

This section develops feedback control laws that control a spacecraft contain- 
ing reaction wheel control devices. The following section will deal with CMG 
and VSCMG control and steering laws. Assume a rigid spacecraft has N re- 
action wheels attached. Each RW spin axis is denoted through the body fixed 
vector gs,. The equations of motion for this system were developed in Chapter 4 
within Example 4.5 and are repeated here for the reader’s convenience. 


Urw]w = —[@] (Urw|w + [Gs]hs) — [Gs]us + L (7.158) 
Note that the inertia matrix [Ipw] is fixed as seen by the body frame B and is 
defined as 


N 
rw] = Us] + 5 (F690, + Jo. Go:99.) (7.159) 


wl 
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The RW motor torques us, are given by 
tig Te, (9% +4 gi) (7.160) 
The angular vector components of h, are given by 
hs, = Js; (Ws; + 2:) (7.161) 
Let the angular velocity error vector dw be defined as 
OW = W — Wr (7.162) 


where w, is the reference angular velocity vector. The attitude error between 
the current body and reference frames is chosen to be expressed through the 
MRP vector o. Other attitude parameterizations could have been used here 
instead too. To provide a positive definite scalar measure of both the attitude 
and angular velocity tracking error, we use Eqs. (7.33) and (7.67) to construct 
our Lyapunov function V. 


V(o, dw) = 5600" [rw bw +2KIn(1+o7o) (7.163) 


Note that the components of dw and [Ipw] are taken in the B frame. After 
setting the derivative of V equal to the negative semi-definite function 


V = —dw[P]ow (7.164) 
the following closed loop dynamics are obtained. 


Bq 
[Law] (dw) = —Ko — [Plow (7.165) 


After substituting the equations of motion in Eq. (7.158) and making use of 
Eqs. (7.35) and (7.162), the RW motor torque vector is defined through the 
constraint 


[Gs]us = Ko + [Plow — [O] ([Irw]w + [Gs]hs — wr) 
— (Irw] (w, —WxX Wr) +24 (7.166) 
Let us combine the terms of the right hand side of Eq. (7.166) to form the 


required torque vector DL, that the RW cluster must produce. The control 
constraint is then expressed compactly as 


[Gs]us = L, (7.167) 


If at least three or more RWs are present and their spin axes g,, span the entire 
three-dimensional space, then the RW cluster will be able to produce in principle 
any required torque vector L,. For the special case where the spacecraft only 
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contains three RWs, and each is aligned with one of the principal body axes, 
then [G] = I3x3 and the RW motor torque vector is simply given by 


us = Ly (7.168) 


For the more general case where a redundant set of RW are present, the vectors 
us, and L,. will not have a one-to-one correspondence. Here there actually exists 
an infinite number of us, combinations that will produce the required torque 
vector L,. One common method used to solve for the actual RW motor torques 
is to use a Minimum norm inverse. 


us = (Gs)? ([Gs|[Gs]7) Ly (7.169) 


This method provides at any instance of time the smallest set of RW motor 
torques that combined produce L,. Even though V is only negative semi- 
definite, it was shown in Eq. (7.87) that this control law is indeed asymptotic 
stabilizing. A major advantage of this RW control law when compared to those 
of other moment exchange devices is that it is relatively simple in nature and 
easy to implement. The limitation of RWs include the relatively small torque 
produced by the device and the problems of having RW saturate. Each RW 
has an upper limit on how fast its rotor can be safely spun up. This rotor rate 
range constrains the torque that can be produced. Further, the faster a RW 
is spinning, the more power is consumed to produce a required torque. The 
kinetic work rate for a spacecraft with a system of RW can be deduced from the 
more general work rate in Eq. (4.119). 


N 
T=w'L+S Os, (7.170) 


i=1 


This work rate expression shows clearly that the larger (0; is, the larger the work 
rate of the RW motor torque us, will be. 


7.¢ Variable Speed Control Moment Gyroscopes 


Control moment gyroscopes contain a rotor whose spin rate 2 is held constant. 
By rotating (also referred to as gimbaling) this rotor about some axis other 
than the spin axis, a gyroscopic torque is produced onto the spacecraft (see 
Figure 7.10. Single-gimbal CMGs only contain one body fixed gimbal axis. 
Their major advantage is that for a small torque input about the gimbal axis, a 
large torque output is produced about the transverse axis. This phenomena is 
called the torque amplification effect. Their drawback is that the corresponding 
steering law is more complicated than that of the RWs and that singular gimbal 
angle configurations exist where the required torque is only partially produced, 
if at all. Dual-gimbal CMGs have a second gimbal axis. These devices don’t 
have as large of a torque amplification effect, but their steering law is less prone 
to encounter singularities. 
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Figure 7.10: Schematic Illustration of a Momentum Exchange Device 


The concept of Variable Speed Control Moment Gyroscopes (VSCMGs) are 
a more recent addition to the family of momentum exchange devices. VSCMGs 
are essentially single-gimbal CMGs where the rotor spin speed 2 is allowed 
to be time-varying. Each device is capable of producing two torque outputs 
if necessary giving a spacecraft more redundancy in case of hardware failure. 
Nominally these devices are operated as regular CMGs unless the gimbal angles 
approach a singular configuration, where the RW mode is utilized to ensure that 
the required torque is produced at all times. 

The control and steering laws of the single-gimbal CMGs and the VSCMGs 
are developed here as one. By holding the RW rotor rate 0; constant, the 
VSCMG steering law is falls back to the classical CMG steering law. 


7.7.1 Control Law 


The following VSCMG feedback control law is derived using Lyapunov control 
theory. Given some initial angular velocity and attitude measure, the goal of this 
control law is to track some reference trajectory defined through the reference 
angular velocity vector w,(t). By holding the RW spin speeds 9; constant 
this control law, along with the associated steering laws, is easily converted to 
the conventional CMG feedback control and steering laws. The MRP attitude 
vector o is chosen again to measure the relative attitude error between the 
body frame B and the reference frame R. The body angular velocity error 
vector dw is defined in Eq. (7.31) along with its local 6 frame derivative defined 
in Eq. (7.35). Note that the vector components of w, and w, are typically given 
in the R frame and are assumed to be known. 

In designing the feedback control law, it is assumed that estimates of the 
state vectors w, ao, 9; and y; are available. The following Lyapunov function V 
is a positive definite, radially unbounded measure of the total system state error 
relative to the target state dw = 0 = 0, where K is a scalar attitude feedback 
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gain.!” 


V (bu, 0) = Su [I] buy + 2K log (1+ 070) Chi) 


The total spacecraft inertia matrix for this dynamical system was developed in 
Eq. (4.115) and is expressed as 


N 

i=l 
Note that all the body angular velocity vectors and inertia matrices have com- 
ponents taken in the B frame in Eq. (7.171). Using Eq. (7.68), the Lyapunov 
function rate V is then given by 

Vase (in wasn ee (7.173) 
= — — o : 
dt 2 dt 

Note that the spacecraft inertia matrix [J] must now be treated as time varying 
as seen by the 6 frame because of the CMG gimbaling. Since the Lyapunov 
function V is a scalar quantity, taking its derivative simply involves taking 
the derivatives of its scalar components. Since the inertia matrix [J] and dw 
have components taken in the 6 frame, their derivatives are taken as seen by 
the 6 frame. Using the inertia matrix definition in Eq. (7.172) and the 6 frame 
derivatives of the gimbal frame unit vectors in Eq. (4.98), the B frame derivative 
of [J] is 


By N 
alll = 30 i Jai — Jes) (Gait, + 97,95.) (7.174) 
i=1 


To guarantee stability of the closed-loop system, the Lyapunov rate function is 
set equal to the negative semi-definite function V = —dw?|P]éw, which, when 
combined with Eq. (7.173), leads to the stability constraint: 


18d 

2 dt 
After substituting Eqs. (4.117) and (7.174) into Eq. (7.175), the following sta- 
bility constraint is obtained. 


[I]6w = —Ko — [Plow []bw (7.175) 


N N N 
5 oe s - 1 ‘ i 
S° I, QUGs; ar Sy J 4 VG gi a S° Vi (4.040, ce (Js = Jt;) (wt, Gs; aI Ws, Gt; ) 


‘ ; : 2 
w=1 i=l 1 
1 A on i te 
= Ko + [Plow + L— [allo — [| (@, — (Be) 
N 
S> Is; (Qiwg9, Gt; = Q;wW4; Gg; ) (7.176) 


i=l 


als J (wt: Gs: Ws; Gt: ) 7 
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To express this condition in a more compact and useable form, let us define the 
following 3xN matrices, where all components are taken in the 6 frame: 





[Do] = [++ 95:5: +++] (7.177a) 
[Di] = [- +: Js; (2 + 5s) Gi, + 50nd) vee] (7.177b) 
[D2] = [--- ah (w,Gs; + Ws, Gt;)°°*] (7.177c) 
[Ds] = [++ Jg; (Wt Gsi — Ys: Gti) *-*] (7.177d) 
[Da] = 5 (dos — Jie) (GesdBere + G02 07) --] (7.1776) 
[B] = [--- G9: Jo.°°*] (7.177£) 
Let Q, + and ¥ be Nxi vectors whose +th element contains the respective 
VSCMG angular velocity or acceleration or RW spin rate. The stability con- 


straint in Eq. (7.176) then is expressed as!” 
[Do]Q + [B]¥ + [D]¥ = Ly (7.178) 


where [D] = ([Di] — [D2] + [Ds] + [D4]) and the required torque vector L,. is 
defined to be 


L, = Ko + [Pléw + L — [a][I]w — [I] (&, — [@]wr) 
N 
— SF Js, (Miwa. Gr, — MW Gg:) (7-179) 


Dropping the [Do]Q term in Eq. (7.178), the standard single-gimbal CMG sta- 
bility constraint is retrieved as it is developed in Ref. 26. Note that the for- 
mulation presented here does not require any matrix multiplications of sparse 
matrices and the effects of the individual VSCMG inertia terms are immedi- 
ately evident. The condition in Eq. (7.178) only guarantees global stability in 
the sense of Lyapunov for the states dw and o, since V was only set to be neg- 
ative semi-definite, not negative definite. However, the negative semi-definite 
Lyapunov rate expression does show that dw — 0 as time goes to infinity. To 
prove that the stability constraint in Eq. (7.178) guarantees asymptotic stability 
of all states including o, once again the higher time derivatives of V must be 
investigated. For this dynamical system V is zero whenever dw is zero. Using 
Eq. (7.175) and setting dw = 0, the third derivative of the Lyapunov function 
V is found to be the first, non-zero higher order derivative and is expressed as 


da 
Bt 


V =—-K?oT ((71)7 


[Pl~te (7.180) 
which is a negative definite quantity since both [J] and [P] are positive definite 
matrices. Therefore the stability constraint in Eq. (7.178) does guarantee global 
asymptotic stability. 
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If the desired spacecraft trajectory is a stationary attitude, then the reference 
body angular velocity vector w, is zero. For these rest-to-rest or motion-to- 
rest type maneuvers, the feedback control law in Eq. (7.178) can be greatly 
simplified. After substituting Eqs. (4.117) and (7.174) into Eq. (7.173) and 
rearranging some terms, the Lyapunov rate function V is expressed as 


N N 
V = —w! G [I]w + S Fe Vids, ae oe J, iViGg: 


i=l wl 


N N 
‘ 1 ‘ i : P 
=r oe Is Vi (0. + 2 (wt: Gsi + nd) = Kho D+ S° Is,Q (wa. Gti = wt; Gg: ) 
i=1 i=1 

N N 

_ 1 ss F f ‘ ‘ 
a S- Fe Vi5 (Ws,Gt; an wt, Gs; ) cle S- J, a Vi (wt: Dai a wn.) (7.181) 

i=1 i=1 
For this regulator problem, several terms in Eq. (7.181) can be shown to be 
nonworking and are neglected in the resulting feedback control law. Setting 
V = —w?|P\|w and performing further algebraic manipulations, the simplified 
stability constraint for the regulator problem is found to be 


N N N N 
S 7 Fe QiGes + d— ToeViGor + 9, TocVi (M4 + Woe) Ge — Do Jee Vids 
i=1 i=1 i=1 i=1 
=Ko+(|Plw+L=L, (7.182) 
Note that L, defined in Eq. (7.182) is a simplified version of the one defined in 
Eq. (7.179). Making use of the 3 x N matrices 


[Do] = [---GsiJsi °°] (7.183a) 
[Di] = [++ Gt, Js; (Qi + ws;)--+] (7.183b) 
[Do] = [++ Gt: Jews, °°] (7.183c) 
[B] = [+++ G9.Fo.°°°] (7.183d) 
the stability constraint is written in the following compact form!” 2” 
[Do]Q + [B]¥ + [D]y = Ly (7.184) 


where [D] = ([Di] — [D2]). Note that the matrices [Do] and [B] are the same as 
with the general feedback law. The matrices [D1] and [D2] are simplified and 
have columns which solely depend on the g;, directions. The matrices [D3] and 
[D4] do not appear at all in this control law. Since this regulator control law 
is a specialization of the more general trajectory tracking control law, it too is 
globally asymptotically stabilizing. 


7.7.2 Velocity Based Steering Law 


Note that the stability constraints in Eqs. (7.178) and (7.184) do not contain 
the physical control torques us, and ug, explicitly. Instead, only gimbal rates 
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and accelerations and RW accelerations appear. This will lead to a steering 
law that determines the required time history of y and Q such that Eq. (7.178) 
is satisfied. The reason for this is two fold. First, currently available CMGs 
typically require the gimbal rate vector ¥ as the input, not the actual physical 
torque vector u,. Secondly, writing Eqs. (7.178) and (7.184) in terms of the 
torque vectors us and u, and then solving for these would lead to a control 
law that is equivalent to solving Eq. (7.178) directly for the gimbal acceleration 
vector +y. As has been pointed out in Ref. 26, this has been found to give a very 
undesirable control law with excessive gimbal rates. A physical reason for this 
is that such control laws provide the required control torque mainly through 
the [B]*+ term. In this setup the CMGs are essentially being used as RWs and 
the potential torque amplification effect in not being exploited. Because CMG 
gimbal inertias J, are typically small compared to their spin inertia Js, the 
corresponding [B] will also be very small which leads to very large + vectors. 

To take advantage of the potential torque amplification effect, most of the 
required control torque vector L, should be produced by the larger gyroscopic 
coupling [D]+ term. This is why classical CMG steering laws control primarily 
the + vector and not +. For the VSCMGs it is desirable to have the required 
torque L, be produced by a combination of the Q and + terms in Eqs. (7.178) 
and (7.184). To simplify the further development, we assume that the final 
angular velocity is zero Therefore the stability constraint in Eq. (7.184) is used. 
However, the results are equally valid for the trajectory tracking control law. 
To force the required torque to be produced by the gimbal rates, the terms 
containing the transverse and gimbal VSCMG inertias are ignored at this level. 
Eq. (7.184) then becomes 


[Do] + [Dil¥ = L, (7.185) 


Comparing the [D,] matrix to that of conventional CMG steering laws of the 
form 


[Di]¥ = L- (7.186) 


such as ones found in Ref. 26, it is evident that an extra g;J,w, term is present 
in the definition of the [D,] matrix in the VSCMG formulation. This term is 
neglected in the standard CMG formulation since it can be assumed that w, 
will typically be much smaller than 2. However, since for a VSCMG the RW 
spin speed 2 is variable, this assumption is no longer justified for the more 
general VSCMG case and this term is retained in this formulation. To solve 
the conventional CMG feedback control constraint in Eq. (7.186) for the gimbal 
rates, a minimum norm inverse is typically used. However, if the rank of the [D1] 
matrix drops below 3, then a steering law singularity where the minimum norm 
inverse may not be possible mathematically. To operate mathematically in the 
neighborhood of these singular gimbal configurations, Nakamura and Hanafusa 
introduce in Ref. 28 a modified minimum norm inverse 


4 = [D1]? ((DiJ [Di]? + alsx3) Ly (7.187) 
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The scalar parameter is only non-zero in the neighborhood of a singularity and is 
typically very small in magnitude. This allows the CMG steering law to produce 
gimbal rates even in the mathematically ill-conditioned singular neighborhoods. 
The draw-back of this method is that the resulting torque produced by the CMG 
cluster is not precisely equal to the required torque vector L,. This will cause 
path deviations of the spacecraft from the prescribed trajectories. Also, the 
modified minimum norm inverse does not avoid the problem of having a gimbal 
lock. If the L, is perpendicular to the range of [D,], then a zero gimbal rate 
vector is produced. The gimbal effectively remain locked in this configuration, 
producing no effective torque, until the required torque vector L, is changed 
somehow. 

By finding a steering law for the VSCMG case, we avoid many of the con- 
ventional CMG singularities by taking into account that the RW rotor speeds 
are allowed to be time varying. For notational convenience, we introduce the 
2Nx1 state vector 7) 


— " (7.188) 
and the 3x2N matrix [Q] 
(Q| = [Do D,| (7.189) 


Eq. (7.185) is then written compactly as 


[Q]7 = L, (7.190) 


Note that each column of the [Do] matrix is a scalar multiple of the g,, vectors, 
while each column of [D;] is a scalar multiple of the g;, vectors. In the classical 
4 single-gimbal CMG cluster, singular gimbal configurations are encountered 
whenever the rank of [Dj] is less than 3. This occurs whenever the g;, axes 
no longer span the three-dimensional space, but form a plane or a line. Any 
required torque which does not lie perfectly in this plane or line cannot be 
generated exactly by the CMG cluster and the spacecraft would deviate from 
the desired trajectory. If the required control torque is perpendicular to this 
plane, then the CMG cluster produces no effective torque on the spacecraft. 
This singular behavior is illustrated in Figure 7.11 with two CMGs gimbaling 
to produce a constant torque vector L,. Since each CMG produces a torque 
about its transverse axis, the two wheels must be gimbaled symmetrically and 
at the same rate to produce the indicated required torque vector L,.. As both 
transverse axes rotate toward perpendicular orientations relative to L,, the 
associated gimbal rates become exceedingly large to produce the required torque. 
This is referred to as operating in the neighborhood of a singular configuration. 
If both transverse axes are perpendicular to L,., then no torque is produced 
(referred to as gimbal lock). 

These singular configurations can never occur with a VSCMG steering since 
the rank of the [Q] matrix will never be less than 3. Since the g;, vectors are 
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Figure 7.11: Dual CMG System Encountering a Singularity 


perpendicular to the g;, vectors, even when all the transverse axes are coplanar, 
there will always be at least one spin axis that is not in this plane. Therefore 
the columns of [Q] will always span the entire three-dimensional space as long 
as at least 2 or more VSCMGs are used with distinct g,, vectors. We mention, 
however, that while a singularity does not occur, this does not imply that other 
difficulties, such as wheel saturation, will not be encountered occasionally. 

Since the [Q] matrix will never be rank deficient, a minimum norm solution 
for 7) can be obtained using the standard Moore-Penrose inverse of Eq. (7.190). 
However, since ideally the VSCMGs are to act like classical CMGs away from 
single-gimbal CMG singular configurations, a weighted pseudo inverse is recom- 
mended instead.?? Let [W] be a 2Nx2N diagonal matrix 


[W] = diag{W.,,--. ;Wsn,Wors---,Won} (7.191) 


where W,, and Wg, are the weights associated with how active each of the RW 
and CMG modes are. Setting a weight to zero effectively turns that particu- 
lar mode off. The larger the weight, the more important that mode is in the 
VSCMG steering law. The desired 7 is then found through?’ 


fe A = [WIlQI? ([Q|(WIIQ)7) 7 L, (7.192) 


Note that there is no need here to introduce a modified pseudo-inverse as Naka- 
mura and Hanafusa did in developing the singularity robustness steering law in 
Ref. 28. To achieve the desired VSCMG behavior, the weights are made de- 
pendent on the proximity to a single-gimbal CMG singularity. One method to 
measure the proximity to a singularity is to compute the non-dimensional scalar 
factor 6 defined as 


6 = det = ([D:][D1]*) (7.193) 
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where fh is a nominal RW angular momentum. With classical CMG configura- 
tions, typically each CMG has the same spin axis angular momentum magnitude 
h. This quantity can easily be factored out of [D1] to render 6 non-dimensional. 
However, since VSCMGs have potentially time varying spin axis angular mo- 
mentum magnitudes, one has to divide [Di] by a nominal spin axis angular 
momentum magnitude h to render 6 non-dimensional. As the gimbals approach 
a singular CMG configuration, this parameter 6 goes to zero. The weights W,, 
can be defined to as the functions 


W,, = Wo eH?) (7.194) 


where Wwe and p are positive scalars to be chosen by the control designer. The 
gains W,, are simply held constant. Away from CMG singularities, this steering 
law will have very small weights on the RW mode and essentially perform like 
a classical single-gimbal CMG. As a singularity is approached, the steering law 
will start to use the RW mode to ensure that the gimbal rates do not become 
excessive and that the required control torque L,. is actually produced by the 
VSCMG cluster. 

Two types of CMG singularities are commonly discussed. The simpler type 
of singularity is when the rank of the [D1] matrix drops below 3 which is indi- 
cated by 6, defined in Eq. (7.193), approaching or becoming zero. The VSCMG 
velocity steering law in Eq. (7.192) handles temporary rank deficiencies very 
well. The required control torque is always produced correctly by making use 
of the addition control authority provided by the RW modes. Another type 
of singularity is when the required control torque is exactly perpendicular to 
the span of the transverse VSCMG axis (i.e. LD, is in the nullspace of [Dj]). 
Naturally, this is only possible whenever 6 is zero. To measure how close the 
required torque L,. is to lying in the nullspace of [D;], the scalar orthogonality 
index O is used.?° 


A Ly [DiJ"[DiJL, 


O= = 
he || Ll? 


(7.195) 
Whenever L,. becomes part of the nullspace of [Dj], then O will tend towards 
zero. A classical single-gimbal CMG steering law demands a zero ¥ vector 
with this type of singularity which “locks up” the gimbals produces no effective 
torque on the spacecraft. The VSCMG steering does not prevent the gimbals 
from being locked up in these singular orientations; however, the D,. vector 
is still being produced thanks to the RW mode of the VSCMGs. If a gimbal 
lock is actually achieved, then without any further changes, such as a change 
in the required L,., the VSCMG will simply continue the maneuvers acting 
like pure RWs. Running numerical simulations it was found that unless one 
starts the simulation in a pure gimbal lock situation, it was very unlikely for the 
VSCMG steering law to lock up the gimbals. Once a singularity is approached, 
the RWs are automatically spun up or down which also in return affects the 
gimbal orientation and lowers the likelihood of having the orthogonality index 
O go to zero. However, the the current form this VSCMG steering law makes 
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no explicit effort to avoid these singular configurations during a maneuver. In 
essence, once the momentum symmetry (associated with CMG geometry and 
constant wheel speeds) is destroyed; by virtue of variable wheel speeds, the 
corresponding singular geometries are also eliminated. 


7.7.3 VSCMG Null Motion 


To perform a given spacecraft maneuver, there are an infinity of possible CMG 
configurations that would produce the required torque vector L,. Depending on 
the torque direction and a given CMG momentum, some of these initial gimbal 
configurations will encounter CMG singularities during the resulting maneuver 
while others will not. Vadali et al. show in Ref. 30 a method to compute a 
preferred set of initial gimbal angles -y(to) with which the resulting maneuver 
will not encounter any CMG singularities. The method computes ~y(to) off- 
line before the maneuver is performed. To reorient the CMG cluster to these 
preferred gimbal angles, the null motion of the steering law [D1] = L, is used. 
This null motion allows for the gimbals to be reconfigured without applying 
any torque on the spacecraft. However, the set of gimbal angles between which 
one can reorient the classical CMGs is very limited, since the internal CMG 
cluster momentum vector must remain constant during this maneuver. Also, 
the null motion involves the inverse of the [D,][D,]7 matrix which has to be 
approximated with the singularity robustness inverse whenever the determinant 
goes to zero. This approximation results in a small torque being applied to the 
spacecraft itself. 

Rearranging VSCMGs instead of CMGs however, there are now twice as 
many degrees of control available. A common four-CMG pyramid configu- 
ration would have eight degrees of control instead of four, and more impor- 
tantly, instead of having a one dimensional nullspace, we have a five dimensional 
nullspace. In particular, the CMG angles can be rearranged in a more general 
manner by also varying the RW spin speed vector 2. The null motion of the 
control law in Eq. (7.190) is given by 


a= [Dita (lanvi@l") fa) = thwsawl] d= [la (7.196) 


where [W] is another diagonal weight matrix which controls how heavily either 
the CMG or RW mode is used in this null motion. The vector d provides a 
direction to which to drive the state vector 7. 

Note that the matrix [r] is a projection matrix and has the useful property 
that [7][7] = [7]. Let the constant vector ny be a preferred set of Qy and yr. 
The difference between the current and the preferred VSCMG states is expressed 


as 
2-2 AQ 
An=n-1 = f\= 7.197 
n=n-nF ee) cs) (7.197) 
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The state error vector e is defined as 


e = [AJAn (7.198) 
where [A] is the diagonal matrix 
In x] [Onxn] 
Aj = |Crwlnx 7.199 
[4] [On xn] acuallnxn] ( ) 


The parameters arw and agya are either 1 or 0. If one is set to zero, this 
means that the resulting null motion will be performed with no preferred set of 
either Qy or ys. The derivative of e is 


é= [Al (7.200) 


The total error between preferred and actual CMG angular speed states is given 
through the Lyapunov function 


1 
V.(e) = xe e (7.201) 


Using Eqs. (7.196) and (7.200), the derivative of the Lyapunov function is 


Ve =e7é=e'[Al[r]d (7.202) 
After setting d = —k.e, where the scalar ke is a positive gain, and making use 
of the properties [A]e = e and [r][7] = [r], Ve is rewritten as 

Ve = —kee™ [7][r]e < 0 (7.203) 


If the weight matrix [W] is written as 
[W] = Why xen] (7.204) 
then the matrix [rT] becomes symmetric and [7] = [7]”. Using this property, the 
Lyapunov rate is expressed as 
Ve = —kee™ [r7 [Tle = —ke ([r]e)" [re < 0 (7.205) 
which is negative semi-definite. Therefore the corresponding VSCMG null mo- 
tion 


: -1 AQ. 

f= he [QI (QI) 2] Utwawl] LAAN) (7.206) 
is a globally stable motion. Numerical simulations show that the weight ma- 
trix [W] does not have to be restricted to the form in Eq. (7.204). Different 
weights can be applied to the individual CMG and RW modes with the resulting 
VSCMG null motion 


=k. [HLF (IATA) ta)- Utwenl] A (QH) (7207 
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remaining stable. Note however, that no guarantee as to asymptotic stability 
can be made. As was the case with the classical single-gimbal CMG null motion, 
it is still not possible to reorient between any two arbitrary sets of 7 vectors, 
since the internal momentum vector must be conserved. If the momentum is 
not conserved, then some torque acts on the spacecraft. 


Example 7.15: A rigid spacecraft is equipped with four identical VSCMGs ar- 
ranged in the standard pyramid configuration as shown in Figure 7.12. While 
maintaining a constant spacecraft attitude, it is desired to rearrange the cur- 
rent set of asymmetric gimbal angles to a new set of preferred symmetric 


angles yr. 





Figure 7.12: VSCMG Pyramid Configuration 


This task is attempted both with the conventional CMG null motion and the 
VSCMG null motion, even though we know in advance that the CMG null 
motion will not be able to complete this task successfully without exerting 
a torque on the spacecraft. The VSCMG null motion in Eq. (7.206) is used 
in this study where equal weights are applied to the RW and CMG modes. 
The parameter arw is set to zero, indicating that the RW wheel speeds 22; 
can be changed by the VSCMG null motion as necessary to drive the gimbal 
angles towards their preferred values. 


The simulation parameters are shown in Table 7.5. The spacecraft is at rest 
and the feedback control law is turned off. Both of the following null motions 
reconfigured the gimbal angles without changing the spacecraft attitude. The 
CMG and RW states for both the CMG and VSCMG null motion are illustrated 
in Figure 7.13. The states of the CMG null motion are indicated with a dashed 
line, while the states of the VSCMG null motion are depicted with a solid line. 
As predicted, both simulations remained stable. They differed however in their 
ability to complete the given task. 

Figure 7.13(i) compares the gimbal angles of either null motion. As expected, 
the CMG null motion does a poor job in driving the initial gimbal angles -+y(to) 
towards the computed set of symmetric preferred angles y¢. While two gimbal 
angles do approach the +45 degree marks, the other two remain far away. 
However, the VSCMG null motion is able to drive the gimbal angles fairly 
close to the preferred gimbal angles. The corresponding gimbal rates for 
either null motion are shown in Figure 7.13(ii) and are small for both cases. 
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Table 7.5: VSCMG Simulation Parameters 


Parameter Value Units 
Is, 86.215 ke-m” 
Isp 85.070 kg-m? 
Fs 113.565 kg-m? 

0 54.75 degrees 
Js 0.13 kg-m? 
Jt 0.04 kg-m? 
Ja 0.03 kg-m? 
yi(to) (00020) deg 
4: (to) [(O000] rad 
Q(to) 14.4 rad/sec 
Ke 0.1 


If the required gimbal rates were too high, then they could be reduced by 
lowering the gain ke and therefore slowing down the null motion maneuver. 
The VSCMG null motion comes much closer to achieving the task by being 
able to vary the RW spin speeds as shown in Figure 7.13(iii). During the first 
40 seconds of the maneuver the (2; are changed steadily to counter the torque 
produced by rearranging the gimbal angles into a more symmetric configura- 
tion. From then on the Q; remain relatively constant. The corresponding RW 
motor torques are shown in Figure 7.13(iv). Again the most active region is 
during the initial 40 seconds of the maneuver. What is important to note is 
that the magnitudes of the required RW motor torques are very small. In fact, 
they are small enough to be feasible with existing RW motors on conventional 
CMGs. Using this type of null motion therefore only requires a change in the 
RW feedback control law, and not a change in the hardware design of the 
CMG itself. Changing the RW feedback law however allows for the gimbals 
to be rearranged in a much more general manner than is possible with the 
conventional CMG null motion. 


Another use of the VSCMG/CMG null motion to avoid singularities is to 
use the redundant degrees of freedom to continuously rearrange the gimbals 
such that a singularity index is minimized. If a singular gimbal configuration 
is approached during a maneuver, then the gimbal angles are automatically 
rearranged using the VSCMG null motion to reduce the singularity index. This 
method has the advantage that no preferred Q and + state vectors need to 
be computed prior to the maneuver. Since it is still theoretically possible to 
encounter a CMG singularity, this method is very useful when combined with the 
VSCMG steering law. While the VSCMG steering law may require very large 
RW motor torques to drive through a CMG singularity, using the VSCMG null 
motion early on to rearrange the gimbal angles to less singular configurations 
can lead to drastic reductions in the required RW motor torques. 

In order to drive the gimbal configuration towards a “less singular” config- 
uration, a measure of singularity proximity is needed. A gradient type method 
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Figure 7.13: CMG and VSCMG Null Motion Simulation 


is developed below that provides the necessary state error vectors AQ and Avy 
for the VSCMG null motion in Eq. (7.207). The non-dimensional singularity 
indicator 6 could be used here as the singularity measure of the VSCMG null 
motion steering law. However, since using the gradient method requires taking 
analytical partial derivatives of the singularity measure with respect to the gim- 
bal angles, this would lead to very complex equations which have to be derived 
specifically for each physical system. 

Instead, the condition number « of the matrix [Dj] is used as the singularity 
measure. Using a singular value decomposition (SVD), the 3 x N matrix [Dj] 
is decomposed as 


1100 0 = 

1 

[D1] = [U][E][V]* = Jur usus}} 0 o2 0--- O]for--- ow (7.208) 
0 0 o3 0 


where [U] is a 3 x 3, [] is a 3 x N and [V] is a N x N matrix. Assume 
that the singular values have been arranged such that 0, > 02 > o3. The 
non-dimensional condition number « is then defined as 
O1 


(7.209) 


K= 
93 
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As the gimbal angles approaches a singular CMG configuration, the index k 
would grow very large since 03 — 0. The theoretically best possible matrix 
conditioning would be with 0, = o3 where k = 1. The goal of the VSCMG 
null motion would be to minimize the singularity index « during a maneuver. 
Let «(t) be the singularity index at the current time and let «(t*) be the index 
after a discrete gimbal angle adjustment has been made. Using a Taylor series 
expansion of «& in terms of the gimbal angles y; yields 


«(tt) = «(t) + or ay (7.210) 


Since ideally «(t*) = 1, using a minimum norm inverse, the desired gimbal 
angle correction is given by 


(1 — K(t)) x 


Ay =a on 7.211 
EP OF en 


where the positive scalar a scales the gradient step. As will be shown with 
numerical examples, Eq. (7.211) works well when the gimbal configuration is 
to be rearranged while the spacecraft attitude is held stationary. However, if 
Eq. (7.211) is used to drive the gimbal angles away from singular configurations 
during a maneuver, then the VSCMG null motion corrections become too “soft” 
as a singular configuration is rapidly approached. The |0«/07|? term in the 
denominator drives Ay to zero as Ok /O-y becomes very large in the neighborhood 
of a singularity. To counter this softening effect, the following stiffer gimbal 
correction algorithm is proposed. 
OK 

Ay = a(1 MO) 5 (7.212) 
Numerical studies show that the VSCMG null motion driven by this Avy during 
a maneuver is more successful in keeping the gimbal angles away from singular 
configurations. 

If [D,] is reasonably well conditioned, it is not desirable to have the VSCMG 
be active at this point and drive the gimbal angles to an even better conditioned 
configuration. Doing so would only unnecessarily waste fuel and energy. To 
stop the VSCMG null motion at some pre-determined singularity index Kap, a 
deadband is introduced. Whenever & < kKgp > 1, then we set a = 0. 

Using Eq. (7.209), the partial derivatives of « with respect to the gimbal 
angles are found to be 


OK 1 00, 2G 003 








(7.213) 


OV 03 0% 3 OY 
The partial derivatives of the singular values with respect to the gimbal angles 
are given by® 
Aaj _ 1D 


Fe Gey (7.214) 
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The result in Eq. (7.214) may have to be modified if 01 = 03. However, this 
event will never be encountered if Kay > 1 is adopted. Using Eq. (7.183b), the 
partial derivative of [D1] with respect to 7; is readily found to be 











[Di] 
=[0::-0y; 0---0 7.215 
ad ee (7.215) 
where the +th column vector x; is defined to be 
I, 0Gs, 7 
wi Ste Hepat AAA, Hele ee S ee yy (7.216) 
OY; 7 OY; 


Since the partial derivatives of the gimbal frame axes are given by 


9s; 








= Gt, (7.217a) 
OY; 
OG, Fs 
i = —@,. 7.217b 
On, = 98 ( ) 
the vector x; is expressed compactly as 
Xi = —Gsi Js; (Qs + Ws,) + Gt; Is, (OQ + W2,) (7.218) 


Substituting Eqs. (7.215) and (7.218) into Eq. (7.214) and carrying out the 
vector algebra, the partial derivatives of the singular values with respect to the 
gimbal angles are given by 


Oo; 


pet = (uh xs) Val (7.219) 





Note that these singular value sensitivities can be computed very quickly given 
the vectors u; and v; obtained from a numerical SVD of the local matrix [Dj]. 
Therefore the Avy vector can be easily computed and fed to the VSCMG null 
motion in Eq. (7.207). As the following numerical simulation shows, the end 
result is convenient method to drive the gimbal angles away from singular neigh- 
borhood and maintain a well-conditioned control influence matrix [Dj]. 


Example 7.16: The following numerical simulation illustrates both the use 
of the VSCMG steering law in Eq. (7.192) to produce the required torque 
even in singular CMG configurations, and the use of the VSCMG null motion 
steering law to drive the gimbal angles continuously away from singular CMG 
configurations. The simpler VSCMG null motion in Eq. (7.206) is used here 
which weighs the RW and CMG modes equally. A rigid spacecraft is reoriented 
from large initial displacements to coincide with the target attitude through 
the use of four VSCMGs. The VSCMGs are arranged in the standard CMG 
pyramid configuration shown in Figure 7.12. The spacecraft and VSCMG 
properties are given in Table 7.6. 

Two simulations are performed. One simulation uses only the VSCMG steer- 
ing law in Eq. (7.192). The second simulation superimposes onto this steering 


276 NONLINEAR SPACECRAFT STABILITY AND CONTROL CHAPTER 7 


Table 7.6: Spacecraft and VSCMG Properties 


Parameter Value Units 
T5053 kgm? /sec 
Ts, 6510 kg-m?/sec 
Is, 11122 kg-m?/sec 
N 4 
0 54.75 degrees 
Js 0.70 kg-m? 
Jt 0.35 kg-m? 
ie 0.35 kg-m? 
a(to) (0.40.3 — 0.3] 
w(t) [0.0 0.0 0.0] rad/sec 
vty) [45 —4545 —45] deg 
4(to) (0 00 0] rad 
Q; (to) 628 rad/sec 
QF 628 rad/sec 
[P] [725 477 623] kg-m?/sec 
K 35 kg-m?/sec? 
Ky 1.0 sec” + 
we 40 
Wo, 1.0 
Lb 100 
Kdb 3 


law the VSCMG null motion given Eq. (7.206) with the stiff gradient multi- 
plier in Eq. (7.212) to continuously reconfigure the gimbal angles away from 
singular configurations. The vector 922 is chosen to be the same as the initial 
Q(to) vector, which results in the null motion trying to keep the RW spin 
speeds as close to their original values as possible. The values of the diag- 
onal angular velocity feedback gain matrix [P] were chosen such that each 
mode of the linearized closed loop dynamics is critically damped.!” 2’ The 
null motion weights Ws; and Wo; are set equal in this simulation. Setting 
W., equal to zero would have yielded a pure CMG null motion. This is typi- 
cally the preferred setting. By having W., = Wa; in this simulation, the null 
motion utilizes the RW mode very little. However, setting W:, equal to zero 
would restrict the types of null motion (therefore what types of gimbal angle 
reconfigurations) are possible.’ 7” 


The resulting numerical simulations are illustrated in Figure 7.14. Results 
obtained from the simulation that only utilized the steering law in Eq. (7.192) 
are indicated by a dashed line, results obtained from the simulation with 
VSCMG null motion added are indicated with a solid line. Figures 7.14(i) 
and 7.14(ii) are valid for both simulations and show that the closed loop 
dynamics is indeed asymptotically stable for both simulations. 


Figures 7.14(iii) and 7.14(iv) shows the singularity indices « and 6 for both 
simulations. Without the singularity-avoiding null motion added, the gimbal 
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Figure 7.14: Comparison of Maneuvers With and Without VSCMG 
Null Motion 
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angles approach a singularity twice. During the second approach the non- 
dimensional determinant 6 actually reaches zero and remains zero for a finite 
duration. Therefore it would be impossible to precisely perform this maneuver 
with the conventional CMG steering law. Some modifications would have to 
be used to produce and approximate required torque in the neighborhood 
of this singular configuration. However, the VSCMG steering law is easily 
able to handle this singularity by temporarily using its RW modes. During 
both periods where 6 — 0, the condition number « grows very large as seen 
in Figure 7.14(iii). If the same maneuver is performed with the singularity 
avoiding VSCMG null motion added, the condition number « is reduced from 
the outset and remains relatively low throughout the maneuver. Note that this 
index could have been reduced even more, but it remains essentially around 
the given condition number deadband value of 3. The trade off of lowering 
this deadband value is that the VSCMG null motion ends up reconfiguring 
the gimbals more often (i.e. using more energy). 


One drawback of the VSCMG steering law as proposed in Ref. 27 is that for 
it to be able to drive through singular configurations, a relatively change in Q 
(i.e. large RW motor torque) is required. For this maneuver the associated 2 
changes are illustrated in Figure 7.14(v). Note that the time scale in this and 
some other Figures is changed to better illustrate the “interesting” regions. 
Using the VSCMG null motion to reconfigure the CMG cluster to preferred 
gimbal angles as was done in Example 7.15, it was found that the associated 
RW Q changes were rather small. The same is observed here where the null 
motion is performed during the maneuver itself as seen in Figure 7.14(vi). 


The equivalent RW motor torque vector magnitudes |uw;| are plotted in Fig- 
ure 7.14(vii). Note that classical CMGs already have an active RW control 
motor that simply maintains a constant wheel speed. The additional effort 
required by the VSCMG null motion is visible as small “humps” of the solid 
like at the beginning of the maneuver and before 100 seconds. What is very 
encouraging is that the magnitude of these humps is very small and still easily 
feasible with the standard existing RW torque motors. Conversely, the stan- 
dard VSCMG steering law requires periodically RW torques that are much 
larger and would require some reengineering of the RW control motors. 


The associated gimbal rates for both simulations are shown in Figure 7.14 (viii). 
While the added VSCMG null motion does require periodically higher gimbal 
rates to reconfigure the gimbals, the overall control effort for the CMG mode 
is about the same. Again, the biggest difference in control effort between 
adding the VSCMG null motion or not to the VSCMG steering law manifests 
itself in the required RW control effort. 


Problems 


7.1 Given Euler's rotational equation of motion in Eq. (4.32) and (4.33). 
a) Linearize them about w(t) = 0. 


b) Linearize them about w(t) = w(t). 
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7.2 Examine the following functions V (a) where a = (a1, 22)’. Find if they are pos- 
itive (negative) definite or semi-definite functions. Also state the neighborhood 
Bs(a,) about which this holds. 


a) V(x) = ; (a7 +73) 
(x) = 5 (xj <3 3) 

(x) = log (l+a7 + 2x5) 
(x) = § (xi + 423) 
(x) = 
(x) = 


V(x 


Vv 


x 


& LAS 
Se 


(x? + 4x3) e — (xj +43) 
xt — 201 +02 — dre +5 


zx 


V(a 


7.3 Verify Eqs. (7.68) starting from the Lyapunov function definition in Eq. (7.67). 


7.4 & Several more HW problems and projects will be added to this chapter. 
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Part II 


CELESTIAL MECHANICS 
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CHAPTER EIGHT 


Classical 'Two-Body 
Problem 





Amongst the most important historical development in the history of the sci- 
entific method is Newton’s analytical solution of the two-body problem. In 
Astronomia Nova (1609), Kepler published the first essentially correct solution 
for the motion of planets around the Sun, where the solution was obtained by 
solving the inverse problem of ” given the observed (measured) right ascension 
and declination history of a planet, determine a mathematical model which 
captures the behavior with sufficient rigor that predictions as accurate as the 
measurements can be made.” Kepler was seeking to modify the historical work 
of Copernicus who modeled the planet paths as circular orbits about the Sun. 
Kepler was intrigued by Tycho Brahe’s observations of the orbit of Mars which 
appeared to deviate significantly from the Copernican circular model, and in 
the course of developing a model which fit the data for Mars and all the other 
more circular planetary orbits, he conjectured that the motion was actually an 
ellipse with the Sun at a focus. Kepler’s elegant geometric analysis amounted 
to an insightful, sophisticated curve-fitting operation, but was found to be in 
such excellent agreement with the measurements of the day, that his laws of 
planetary motion were considered exact. 

Newton, in his quest to develop calculus, differential equations, and his fa- 
mous laws of motion, was fascinated by the beauty and precision of Kepler’s laws 
and set about the task of discovering what force law must be existing between 
bodies in the solar system to be consistent with Newton’s laws of motion and 
Kepler’s experimentally verified laws of planetary motion. From this analysis 
came Newton’s discovery of the law of universal gravitation, and the ensuing 
analytical solution of the two-body problem. Because Newton’s analytical so- 
lution for Keplerian motion was an immediate and convincing demonstration 
of the validity of Newton’s calculus, differential equations, and laws of motion, 
the acceptance of Newton’s many allied advancements were immediate. The 
acceleration of the evolution of science and mathematics and the consequences 
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since are simply immeasurable. 

This chapter is essentially a modern rendition of Newton’s analytical solu- 
tion of the two-body problem, however, we make extensive use of matrices and 
other modern mathematical constructions not available to Newton. Because the 
subject relies heavily on geometry of conic sections, we will begin with a brief 
summary of this subject. 


8.1 Geometry of Conic Sections 


Kepler discovered that the orbit of one body about another is an ellipse, which 
is a special case of the intersection curve between a cone and a plane. More 
generally, we will see how Newton proved all of the conic sections are feasible 
orbits. Depending on the slope of the plane relative to the cone’s axis of sym- 
metry, the resulting curves of these conic intersections are either of an elliptical, 
parabolic or hyperbolic nature as illustrated in Figure 8.1. If the relative slope 
of the plane is less than that of the cone symmetry axis, then the resulting inter- 
sections form a closed, elliptic curve. An open (infinite ellipse) parabolic curve 
is the result of the limiting case where both plane and cone symmetry axis slope 
are equal. The hyperbolic curve occurs for plane slopes larger than the relative 
cone symmetry axis slope. Mastering the basic geometry of conic sections is 
of fundamental importance to understanding orbital mechanics. This section 
provides a terse review of some of the more important aspect of the geometry 
of elliptic, parabolic and hyperbolic orbits. 





v we 


Elliptic Intersection Parabolic Intersection Hyperbolic Intersection 
Figure 8.1: Illustration of Conic Intersections 


A sample elliptical orbit is illustrated in Figure 8.2. The shape of an ellipse 
is defined through its semi-major axis a and semi-minor axis b where a > b. Let 
(X,Y) be the coordinates of a body performing an elliptical motion with the 
coordinate system origin chosen to be in the center of the ellipse. The standard 
rectangular coordinate description of an ellipse is given by 

xX? y? 


+ 


=a (8.1) 
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Figure 8.2: Geometry of an Elliptic Conic Section 


Similarly, the rectangular coordinate description of a hyperbola is given by 


xX? y? 
a7 pa! (8.2) 


Instead of describing a location on the ellipse relative to the ellipse geometric 
center, this section develops a description which defines the conic section relative 
to a focal point. 

Every ellipse has two focal points F and F5. For the special situation where 
the ellipse collapses to the circular case (i.e. a = b), the two focal points occupy 
the same point; this clearly corresponds to a planar section normal to the cone 
symmetry axis if Figure 8.1. A well known useful property of an ellipse is that 
the sum of the two radial distances from any point on the ellipse to each focal 
point is constant and equal to 2a. 

An important parameter that describes the shape of conic intersections is the 
non-dimensional constant e called the eccentricity. It indicates whether the conic 
intersection is elliptic, parabolic or hyperbolic. For ellipses the eccentricities 
range between 0 < e < 1. Parabolas always have e = 1 and hyperbolas always 
have eccentricities great than 1. 

With reference to Figure 8.2, we introduce the “directrix definition of a 
conic section.” Begin with constructing two perpendicular lines. On the first 
line locate a point F. Designate the first line as major axis and the second 
perpendicular line as the directriz. The conic section is defined as the curve 
whose radial distance r from F' to a typical point P on the curve has a constant 
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Table 8.1: Naming Convention of Periapses and Apoapses for Orbits 
about Various Celestial Bodies 


Celestial Body Periapses Apoapses 
Sun Perihelion Apohelion 
Mercury 
Venus 
Earth Perigee Apogee 
Moon Periselenium Aposelenium 
Mars 
Jupiter Perijove Apojove 
Saturn 
Uranus 
Neptune 
Pluto 


ratio c to the perpendicular distance from P to the directrix. While the directrix 
itself typically doesn’t appear in the description of orbital motion, it plays a key 
role below in deriving several important conic intersection properties. 

First, we derive another mathematical description of a conic section. While 
Eq. (8.1) and (8.2) each were only valid for one type of orbit, we now develop a 
description valid for any type of orbit. Let the vector r point from the focus F’ 
to the current orbit position with r being its magnitude. The distance p is the 
perpendicular distance (to the major axis) between the focus and the orbit and 
is called the semilatus rectum or simply the parameter.‘ The angle f measures 
the heading of the position vector r relative to the semi-major axis and is called 
the true anomaly. The cartesian r vector components (x,y) are expressed as 


x=rcos f (8.3) 
y=rsinf (8.4) 


Using the property of the directrix, we can see from the geometry of Fig. 8.2 
that the following statement must be true. 


Uae eee (8.5) 


Using Eq. (8.3), this statement is rewritten to express the radial distance r in 
terms of the true anomaly f. 


P 


= —_*__ 8.6 
1+ecos f i8:6) 


Note that Eq. (8.3) not only holds for the elliptical case, but also describes 
parabolic and hyperbolic trajectories. Thus it forms a universal description of 
conic intersections. 

The closest point on the ellipse to the focus is called periapses or perifocus, 
while the furthest point is called apoapses or apofocus. When orbiting about 
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certain celestial bodies, these terms are refined to reflect the fact that the orbit 
is about a particular body. For example, for an orbit about Earth the closed 
and farthest points are called perigee and apogee. Other naming conventions are 
found in Table 8.1. Note the closest point to the focus F' occurs at f = 0, this 
gives the perifocus radius 


T= e 
Pp 1+e 





(8.7) 


For the case of closed orbits, investigate the point at f = a, this give the 
apofocus radius 





jee (8.8) 
l—e 
It is clear that 
Pp Pp 
2 =Tq = ——— 
aA=TatTp oe + ie 
from which 
pee l+e+l-e 
oe 1—e? 
or 
p=a(1—e’) (8.9) 
So we now see that 
rp = a(1 —e) (8.10) 
ra = a(1l +e) (8.11) 


Further, since (from Fig. 8.2) a = OF + rp, then OF = a—r, = ae is the 
distance from the ellipse center O to the focus F. 
The semi-minor axis b can be expressed in terms of a and e as 


b=av1-e? (8.12) 


Therefore, if e — 0, then the orbit becomes circular and b = a. Having 
e — 1 could indicate either one of two situations. The first case is that the 
conic section is becoming parabolic, in which case both a and b would grow 
infinitely large. However, it is also possible for e to approach 1 without the 
orbit becoming an open-pathed parabola. As Eq. (8.12) indicates, if the semi- 
minor axis b shrinks to zero for a fixed and finite semi-major axis a, then the 
corresponding eccentricity e would have to approach 1. At the limit where e = 1, 
the elliptic motion collapses down to a cyclic motion on a finite line segment. 
This case is referred to as the rectilinear motion case. Examples of orbits where 
e — 1 without the flight path becoming parabolic are comets that typically are 
ona “skinny”, near-parabolic orbit about the sun. As will be shown later on in 
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this chapter, the deciding factor whether an object is on an elliptic, parabolic 
or hyperbolic orbit is the object’s energy. 

For the rectilinear motion case where e = 1 and ais finite, the corresponding 
rp is obviously zero. From this it is evident that a completely rectilinear orbit is 
not possible in reality. The celestial body about which the object is orbiting in 
this manner would have to have an infinitesimally small diameter. However, true 
rectilinear fractional-orbits are possible. To illustrate, throw a rock straight up 
in the air on a non-rotating earth. The resulting flight path before the objects 
impacts with the ground (or yourself if you do not step aside) is a true rectilinear 
ellipse. Using Eq. (8.10), the semi-minor axis b in Eq. (8.12) can be written in 


terms of r, and e. 
l+e 
b=Pp\4/ wl 
lp {= € (8 3) 


While the true anomaly f has a convenient direct geometric interpretation, it 
is not always mathematically convenient to express the current location through 
this angle. Instead, the eccentric anomaly E is often used. Imagine the ellipse 
being “stretched” along the semi-minor axis into the shape of a perfect reference 
circle. The angular position of the new orbit location relative to the ellipse center 
is the true anomaly F as shown in Figure 8.2. The following developments 
express various elliptic elements in terms on this eccentric anomaly E. While 
Eqs.(8.3), (8.4) and (8.6) are universally valid, the following expressions using 
the eccentric anomaly FE are only valid for the elliptic special case. To write the 
radial distance r in terms of F instead of using the universally valid f, we use 
the directrix property to state that 





ae + © = acos B+ = (8.14) 
Substituting Eq. (8.9), the radial distance r is expressed as 
r =a(1—ecosE) (8.15) 
Studying Figure 8.2, the semi-major axis component «x is written as 
x = a(cos E — e) (8.16) 


The semi-minor axis component y is found by making use of y = Vr? — x? and 
performing some trigonometric simplifications. 


y=avV1l—e?sinE (8.17) 


Finding a direct relationship between the true anomaly f and the eccentric 
anomaly F is less straight forward than the previous developments. In particu- 
lar, it involves using half angle trigonometric identities whose use is initially not 
very intuitive. Using Eqs. (8.16) and (8.17), the sin and cos of f are written as 
y vl—e*snE 
' 


: Poteet 
=2 Al 
sin f ORs Bl = a eeoee (8.18) 
Sp tee O72 cos H — e 
;f =cos? + —sin? + = 2 = 1 
cos f = cos pg Ge ee (8.19) 
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where the first transformation was performed using standard half angle trigono- 
metric identities. Making use of sin? £ = 1 — cos? > Eq. (8.19) is rewritten 
as 


of  (1-e)(1+cos £) 


2 —— 
ee 2, 1—ecosE 


(8.20) 


After dividing Eq. (8.18) by Eq. (8.20) and performing some simplifications, we 


find that 
f l+e sink 
Te a 21 
yas 1—el+cosE C2) 


The right hand side of Eq. (8.21) can be further simplified by again making use of 
the previous half angle trigonometric identities. The final result is a remarkably 


simple transformation between the true anomaly f and the eccentric anomaly 
E. 





f l+e E 
tan = = tan — 8.22 
an 5 (re an > ( ) 





Note that quadrants are not an issue in the above anomaly transformation. With 
this mapping we will be able to exploit the simpler mathematical expressions in 
terms of F and then translate this angle into the geometrically more meaningful 
angle f for visualization purposes. 








Figure 8.3: Geometry of a Parabolic Orbit 


As the eccentricity e approaches 1 and the semi-major axis a grows to infinity, 
the orbit no longer remains a closed path. At the critical transition, the conic 
intersection shape is that of a parabola with the second focus point F2 having 
moved off to infinity. Figure 8.3 illustrates such a parabolic orbit. Since e = 1, 
note that the distance from any point on the parabola to the focus F) is the 


292 CLASSICAL TWO-BODY PROBLEM CHAPTER 8 


same as to the directrix. Since the distance rp is finite, Eq. (8.13) indicates 
that the semi-minor axis 0 is infinitely large. Eq. (8.7) shows that the semilatus 
rectum for a parabola is simply 


p= 2rp (8.23) 


However, actual orbits are rarely parabolic since the eccentricity must be 
precisely equal to 1. Theoretical analysis therefore typically focuses on the 
more common cases of having either elliptical or hyperbolic orbits. 

Figure 8.4 illustrates the geometry of a hyperbola. While a parabola has 
moved the second focus F2 off to infinity, with hyperbolas this focus reappears 
on the other side of Ff. A common practice in celestial mechanics is to denote 
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Figure 8.4: Geometry of a Hyperbolic Orbit 


the semi-axes a and 6 as being negative quantities for a hyperbola. This results 
in many expressions for hyperbolic parameters being algebraically equivalent to 
their elliptic cousins. Also, this convention will allow us to express the orbit 
energy equation in one algebraic form that pertains to all three possible conic 
section cases. The distance between foci is —2ae > 0, similar as with an ellipse. 
However, the semi-axes a and b now have different geometric meanings. The 
distance between the two hyperbola periapses is —2a. Apoapses points don’t 
make sense in this setting since the curve isn’t closed. A hyperbolic curve will 
asymptotically approach a straight line motion as the true anomaly f grows 
sufficiently large. Unlike with ellipses and parabolas, the hyperbola is essentially 
only curved in the proximity of its focus. Let’s assume a cartesian coordinate 
system is aligned with the semi-axes and has its center between the two foci. 
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The slope ¢ that the hyperbola will asymptotically approach is given by 
1 
¢=cos! 3 (8.24) 


The box of dimension (—2b) x (—2a) between the two perigee points has a 
diagonal of length —2ae. Therefore, the semi-minor axis b for a hyperbola can 
be expressed as 


b=avVe?-1 (8.25) 
Substituting Eq. (8.24), the parameters a and b can be related through the slope 
angle ¢ as 
b? = a? tan? (8.26) 
From the geometry of Figure 8.4, it is evident that 
Tp = (—a)(e — 1) = a(1 — e) (8.27) 


Note that this expression is algebraically equivalent to the elliptic r, expression 
in Eq. (8.10). Using Eqs. (8.6) and (8.27) and setting f = 0, the semilatus 
rectum p for a hyperbola is given by 


p= (—a)(e — 1) = a(1 —e?) (8.28) 
or alternatively through 
p=Tp(lt+e) (8.29) 


As is the case with elliptic orbits, it is convenient to express the location 
within the orbit through another anomaly angle. For hyperbolas the hyper- 
bolic anomaly H is used. In this case the reference hyperbola is created using 
an eccentricity of e = V2 which corresponds to having an asymptotic slope 
of 45 degrees. Following similar steps as was done with the elliptic case, the 
parameters r, x and y are expressed in terms of H as 


r = (—a)(ecosh H — 1) = a(1 — ecosh H) (8.30) 
x = (—a)(e — cosh H) = a(cosh H — e) (8.31) 


y = (—a) Ve? — 1 sinh H (8.32) 


Finding the direct relationship between the true anomaly f and the hyper- 
bolic anomaly H again involves half-angle identities. Besides the previously 
shown standard half-angle trigonometric identities, the following hyperbolic 
identities are used. 


1 = cosh? x — sinh? x (8.33) 
sinh x = 2cosh 5 sinh 5 (8.34) 


cosh x = cosh? 5 + sinh? 5 (8.35) 
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After following the same steps as were done in developing the relationship be- 
tween f and E, the hyperbolic anomaly H is related to the true anomaly f 
through 


i #8 
tan f = ae tanh = (8.36) 


8.2 Relative Two-Body Equations of Motion 


In celestial mechanics, bodies are often treated as particles with their rigid body 
motion neglected. The reason for this naturally being the typical spherical shape 
of massive heavenly bodies and the large relative distances involved. Also, we’ll 
see mass elements of finite bodies can be considered particles and integration 
over the mass distribution gives various derived results for finite bodies. As- 
sume two particles of mass m, and mz are moving generally in space. The only 
forces acting on them is the mutual gravitational attraction and some distur- 
bance forces fa, and fa, as illustrated in Figure 8.5. The magnitude of the 
gravitational attraction is given by Newton’s Law of Universal Gravitation in 
Eq. (2.4). The position vectors R; and Rz are measured relative to an inertial 
reference frame NV. 





Figure 8.5: Gravity and Disturbance Forces Between Two Bodies 


The disturbance forces fa, could be present for various reasons. In a Low 
Earth Orbit (LEO) the aerodynamic drag of the rarified atmosphere could affect 
the motion. Considering the Earth and its moon to be a two particle system, 
then both would experience another gravitational attraction with the sun which 
could be expressed as a disturbance force on the two-body Earth-Moon system. 
In the present discussion the inertial motion of each mass is of lesser importance. 
Instead, we would like to focus on the relative motion between the two bodies. 
The position of mass mg relative to mass ™ is given through the vector 


r= Ro = R, = Tt, (8.37) 
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where r = |r| and 2, = r/r. Using Newton’s equations of motion in Eq. (2.2), 
the inertial equations of motion for each body are written as 


2 Gmym 

mi Ry = ——3—r + fa, (8.38) 
-. Gmiym 

mR, =———3—r + fas (8.39) 


where G is the universal gravity constant. The gravitational coefficient py is 
defined as 


pe = G(m, + m2) (8.40) 
Note that for many systems m, >> mg and yu can therefore be approximated as 
ws Gm (8.41) 


An example of this situation would be a satellite in Earth’s orbit. The mass 
mg of the satellite would be negligible compared to the massive Earth. The 
practical reason for choosing to work with pw instead of G is that w is more 
accurately understood for various systems than is the universal gravitational 
constant G. The product Gm, can be extracted from LEO satellite tracking 
data with a relatively high degree of accuracy. However, measuring G directly 
is much more challenging. More on this later. Taking the difference between 
Eq. (8.39) and (8.38), the equations of motion of mz relative to m, are found 
to be? 


Ps LL 
Sat + Ga (8.42) 
where the disturbance acceleration vector aq is defined as 
1 1 
ag = — fay — — fa, (8.43) 
ms My 


This vector differential equation in Eq. (8.42) is easily the most important re- 
sult in celestial mechanics. It forms the basis for various developments. Note 
that the two disturbance accelerations in Eq. (8.43) are often a near cancella- 
tion. Again we consider the Earth-Moon system with the sun’s gravitational 
attraction modeled as the external influence. Labeling the sun’s mass as m3, 
we express the disturbance acceleration ag as 


1 Gmom3 1 Gm m3 


ag = T13 ~ 0 (8.44) 


mz |r23/3 ye mi |ri3\° 
since T93 & 713. Thus, even though the sun’s gravitational force itself is very 
large, it effect on the relative two-body motion is often negligible. Therefore the 
relative disturbance acceleration vector aq is typically considered to be small or 
actually set equal to zero to obtain a good approximate solution. In this case, 
the relative equations of motion are written as 


foes (8.45) 


r3 
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By defining the relative gravitational potential energy function V as 
V(r) =--— (8.46) 
the relative equations of motion can also be written using the V, operator as 
rF=—-V,V(r) (8.47) 


If the relative position vector r is expressed through the cartesian vector com- 
ponents (x,y,z), then the relative equations of motion are given by 


g=- sy (8.49) 
rT 


which form a set of three coupled , nonlinear, scalar differential equations. The 
differential equations only decouple for the special cases of having a circular 
orbit where the radius r remains constant, or having a straight line orbit (y = 


z=0>2=-4). 


8.3. Fundamental Integrals 


Even though the relative equations of motion in Eq. (8.42) are nonlinear differ- 
ential equation, it is remarkable that an exact analytical solution to them exists. 
This section will show several manipulations which each lead to perfect differ- 
entials. Integrating these differentials then leads to the fundamental integrals of 
an orbit. In the absence of disturbances, these parameters remain constant and 
provide an important, geometrically elegant way to describe an orbit. Further, 
from these fundamental integrals we are also able to verify analytically Kepler’s 
three laws of planetary motion. 


8.3.1 Conservation of Angular Momentum 


In this section we study a variation of the standard angular momentum vector. 
The massless angular momentum vector h is defined as 


h=rxr=hip (8.51) 


A rotating coordinate system M is placed on the mass m, with the unit direction 
vectors {2,., 29, 2, } as shown in Figure 8.6. To see what type of relative motion is 
possible with Eq. (8.42), we differentiate the massless angular momentum vector 
h. Using the chain rule and the relative equations of motion in Eq. (8.42), the 
vector A is written as 


h=txitrxéarx (-Srtaa) =r x aa (8.52) 
i 
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relative tom, 


Figure 8.6: Planar Orbit Motion 


Note that for the case where ag % 0, the angular momentum vector h remains 
inertially fixed since h = 0. This fundamental result is important since it states 
that all possible relative motions will lie in an inertially fixed plane perpendic- 
ular to @,. Since all relative motion will occur in a plane, we introduce polar 
coordinates for the radial and transverse components of r and 7 in this orbit 
plane. The velocity vector r is then given by 


P= 74, + rig (8.53) 


where 6 is the planar rotation rate of the position vector. Using Eqs. (8.37) and 
(8.53), the angular momentum vector h is written as 


h=rx t= (rip) x (rip + rig) = 1764p, (8.54) 
Comparing this result with Eq. (8.51) we find 
h=r'6 (8.55) 


Since h is constant, we find Kepler’s second law of planetary motion which 
states that the relative position vector r sweeps equal areas in equal equal 
times. Thus Kepler’s second law is a geometric property of the conservation of 
angular momentum. 


8.3.2 The Eccentricity Vector Integral 


The following development will introduce the notion of eccentricity into the 
relative equations of motion. Also, it will be apparent that all relative motions 
between two bodies indeed either describe elliptic, parabolic or hyperbolic paths. 
Since the angular momentum h is perpendicular to both r and fr, the vector 
r x h lies in the orbit plane. Assuming ag = 0, then h = 0 and 


d 
a xh)=Fxh (8.56) 
After substituting Eqs. (8.45) and (8.51), the derivative of r x h is written as 


<i xh)= -4r x (r x r) (8.57) 
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Making use of the trigonometric identity 
ax (bx c)=(a-c)b—(a-b)c (8.58) 


and substituting the polar coordinate expressions in Eqs. (8.37) and (8.53), this 
derivative is rewritten as 


d,. Lito, 

ae xh) = “2r —?fr) (8.59) 
The key step in this development is being able to rewrite Eq. (8.59) in the form 
of a perfect differential: 


d dr 
“(i xh) = n= (=) 8.60 
qe) SA (8.60) 
This allows us to trivially integrate this expression by introducing the constant 
vector c. The relative motion between two bodies must therefore satisfy the 
following constraint. 


c=rxh-wu (=) = constant (8.61) 
r 


To gain further insight into the geometric meaning of the constant c vector, we 
perform the dot product between it and the position vector r to find 


reer: (#xh—-y(=)) <2? pr (8.62) 


where the trigonometric identity a- (b x c) = c: (a x b) was used. Making use 
of the dot product definition 


r-c=rjc|cos(Z r,c) (8.63) 
the scalar orbit radius r is expressed as 


h2 

Pieces ee 

7} ’ 
with the expression (Z r,c) being the angle between the two vectors r and c. 
Studying Eq. (8.6), it is evident that Eq. (8.64) geometrically describes a conic 
intersection. Thus we have proven Kepler’s first law of planetary motion which 
states that all relative motions between two bodies are either elliptic, parabolic 
or hyperbolic in nature. Further, we can also express the semilatus rectum p in 

terms of the angular momentum magnitude h as 


h? = up (8.65) 


The angle (Z r,c) is now exposed as being the true anomaly f. This implies 
that the constant vector c is aligned with the semi-major axis and points toward 
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Orbit Plane 






Reference Plane 
(Equatorial Ecliptic) 


Figure 8.7: (3-1-3) Euler Angle Description of the Orbit Plane 


periapses, since f is measured from this axis. Comparing Eqs. (8.6) and (8.64), 
we finally write the eccentricity vector c as 


c= per. (8.66) 


Given current position and velocity vectors of mass mg relative to m4, Eq. (8.61) 
can be used to compute the periapses direction of the conic path. 

The eccentricity and momentum unit direction vectors 7, and 7, respectively 
are illustrated in Figure 8.7. The orientation of the orbit plane O : {%, tp, tn} 
relative an inertial reference frame N : {%,,2,,%,} is typically given in terms 
of the (3-1-3) Euler angles 2 (longitude of the ascending node), 7 (inclination 
angle) and w (argument of the perihelion). If the orbit inclination i goes to 
zero, then this orbit plane orientation description is non-unique. Figure 8.7 also 
illustrates well the angle 6, which is defined as 


G=wtf (8.67) 


Therefore, if the orbit plane orientation is inertially fixed, then w = 0 and if = 6. 
Another useful reference frame is the one that tracks the position of the mass 
m itself and is given by M : {2,, 2%, tn}. 


Example 8.1: The orbit period P can be found through a direct application 
of Kepler’s second law. Separating variables in Eq. (8.55) we find 


hdt = r7d0 


After integrating both sides of the above equation over one orbit, and rec- 
ognizing that the right hand side computes the area A of an ellipse, we find 
that 


hP = A= 2rab 
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Using Eqs. (8.12), (8.9) and (8.65), the orbit period P is then expressed in 
terms of the semi-major axis a and the gravitational coefficient jz as 


a? 
P=2n,/— (8.68) 
LU 


Eq. (8.68) verifies Kepler’s third law of planetary motion which states that 
the term P/a® is a constant. 


8.3.3 Conservation of Energy 


For a dynamical system containing two masses and gravity being the only force 
present, it is clear that the sum of the system kinetic and potential energy will 
remain constant (i.e. the system is conservative). We would like to investigate 
whether a similar “conservation of energy principle” holds for the relative motion 
description we have adopted. The following analysis is performed assuming 
aq = 0. The inertial kinetic energy of m, is 


1 


Ly om gman : Ty (8.69) 
with the kinetic rate expressed as 
Ty = mi, - Py (8.70) 


This motivates us to examine the scalar energy rate like quantity 7-7 for the 
relative motion description. The relative equations of motion in Eq. (8.47) can 
be written as 

OV ~OVOr ov 1 


where the relative potential energy function V is defined in Eq. (8.46). Using 
Eqs. (8.37) and (8.53), the quantity *- 7 is written as 


Pee Gk Gia, (8.72) 
Orr Orr 


Both sides of this equation are then written as the prefect differentials 


dfl. \. wW 
< (5 *) =-7 (8.73) 


After integrating both sides we conclude that the total relative energy for Kep- 
lerian motion is conserved. 


1 
ar -r+V =constant (8.74) 
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Introducing the scalar constant a/2, we obtain the famous energy integral: 


a 


(8.75) 


The expression ar - 7” is defined to be the relative kinetic energy per unit mass 
of mg relative to m1. The expression y4/r represents a gravity potential like 
function per unit mass. For the special case were mz < ml, this expression is 
related to the standard gravity potential function V(r) through 

eo I) = VD) (8.76) 

r r r mg 

The approximation made when we assume that mz < m, implies that the mass 
my is inertially fixed. The motion of mz about m , causes negligible acceleration 
of m,. To visualize such a situation, consider the space shuttle in Earth’s orbit. 
While the shuttle motion will in theory perturb the Earth’s motion, for practical 
purposes this effect can be neglected. However, if the we study the Earth-Moon 
system, then mz & mj, and the approximation in Eq. (8.76) would not be valid. 
Setting v? = *- 7, the energy integral of the relative motion is written in its 
most popular form called the vis-viva equation. 


v= pb (? = a) (8.77) 


r 


In essence, this equation relates the instantaneous scalar position and velocity 
of a body at any point on the orbit through the energy constant a. To express 
a in terms of conic intersection parameters, we examine the orbit radius r and 
velocity v at periapses. First, we develop a for the elliptic case. The periapses 
radius rp, is given in Eq. (8.10). The periapses velocity v, is found by making 
use of Eqs. (8.10), (8.7) and (8.55). 


y2 = p2ge — Tee _ WP _ wa(l—e?) _ wl +e) (8.78) 
pai ake ie re alee ali) 


Using Eq. (8.77), the energy constant a is expressed as 


2 wv 2 l+e (1 —e) 1 
elliptic = — — — = —— - SF =F 8.79 
ene Pe ae). ee) ae oe er) 
Therefore, for the elliptic case, the energy constant a is simply the inverse of 
the semi-major axis a. Since a — oo for the parabolic case, the corresponding 
energy constant a@ goes to zero. 


Qparabolic = 0 (8.80) 


Example 8.2: The energy equations in Eq. (8.77) can be used to readily 
compute various critical velocities. The minimum velocity necessary to escape 
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Table 8.2: Approximate Astrometric Data for the Planets 


Body Symbol Average Radius [km] py [km®/sec”] 
Sun © 696 10° 1.326 107 
Mercury 9 2.43 10% 2.208 104 
Venus Q 6.07 10° 3.248 10° 
Earth @ 6.37 10° 3.986 10° 
Moon C 1.74 10° 4.902 10° 
Mars C 3.40 10° 4.282 104 
Jupiter X 71.3 10° 1.267 10° 
Saturn h 60.1 10° 3.795 10° 
Uranus 6 24.5 10° 5.796 10° 
Neptune wu 25.1 10° 6.870 10° 
Pluto B 2.90 10° 4.402 104 


the gravitational pull of a celestial body is called the escape velocity, which 
corresponds to the object being on a parabolic orbit. 

Various astrometric data is given for our solar system in Table 8.2. Ignoring 
the atmospheric drag, the critical escape velocity magnitude v for a body on 
the Earth’s surface would be 


v= jj ee = 11.06 km/sec 
TO 


On the Moon, how fast would one have to propel an object horizontally 
such that it would never hit the Moon? This would correspond to a circular 
orbit just above the Moon surface (we are ignoring the lunar craters and 
mountains here). For a circular orbit the semi-major axis a is equal to r¢. 
The corresponding velocity magnitude v is then given by 


v=, [EX — 1.68 km/sec 
r¢ 


which corresponds to propelling an object at roughly 1 mile per second. 


For the hyperbolic case, the energy constant is rewritten using the same steps 
as with the elliptic case. Using Eqs. (8.27) and (8.28) along with Eq. (8.55), the 
constant alpha is expressed for the hyperbolic case as 


1 
QAhyperbolic = é (8.81) 


Note that by adopting the convention that a < 0 for hyperbolic orbits, the 
algebraic expression for a is the same for a hyperbola as it is for an ellipse. The 
consequence of this sign convention is that we are able to write a universally 
valid vis-viva equation in terms of a for the three conic section cases. 


v= p (; - -) (8.82) 


r a 
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The various energy levels in Eq. (8.82) clearly illustrate if the orbit trajectories 
of an object form a closed path or not. Note that the quantities v? and a are 
always positive quantities for the elliptic case. Therefore it is impossible for 
the elliptic orbit radius r to go to infinity. As the energy level increases and a 
grows to infinity, at the limiting parabolic case it is possible for the object to 
fly infinitely far away. However, it will only barely be able to reach infinity and 
have no remaining velocity when it gets there. An object on an hyperbolic orbit 
(a < 0) is able to “fly to infinity and beyond” since as r grows infinitely large, 
the object retains a positive escape velocity v? = —p1/a. 

Sometimes it is convenient to write the velocity vector v in terms of its radial 
and tangential components v, = 7 and vg = r6? respectively. Using Eqs. (8.55) 
and (8.65), vg is written as 


pee (8.83) 


Using the energy equation in Eq. (8.82), the corresponding radial velocity com- 
ponents is given by 





2r — 1 
av p= (752-2) (8.84) 


r 


Example 8.3: We would like to study the ballistic missile problem of launching 
an unpowered object and hitting a specific spot somewhere else on Earth. 
For this, we revisit Example 2.2 where a mass is launched under a constant 
gravity field. There, for a given initial velocity vo, there were typically two 
corresponding initial firing angles that would match the target condition. 
When there was only one possible initial angle yo, then the minimum initial 
velocity (energy) was being used. 


Yo 


W, 


Figure 8.8: Ballistic Missile Trajectory 


Similar results are found when a mass is subjected to an inverse-squared 
gravity field such as is the case with sub-orbital flights. Figure 8.8 illustrates 
one suborbital trajectory. Ignoring Earth’s rotation, we can assume Keplerian 
motion. Clearly the initial missile velocity vo would need to be less than 
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the corresponding Earth's escape velocity, otherwise the missile would never 
return back to Earth. Since the missile mass is much less than Earth’s mass, 
the resulting elliptic motion will have its focus at Earth’s center which can also 
serve as an inertial origin. The desired range S' is related to the semi-range 
angle ~ through? 


12 
O= 5. 


NIle 


For the following analysis, it is easier to work with the semi-range angle » 
than with the true anomaly f. First we have to relate y with the initial 
launch states 79 and vo. We do this using the orbit elements a and e. Since 
yp =m — f, we can use Eq. (8.6) and launch conditions to find 


1 
cosy = — cos f = = (.-4) 
© 


The initial position and velocity vector are written in O frame components as 
To = Ret, 
Vo = Vo Sin Yotr + Vo COS Yoto 
Using h = r x v, we express the constant scalar angular momentum hh as 
h = Re@vo0 COS Yo 
The semi-latus rectum is then found to be 


h? ve 
p=— =Re—- 


2 2.2 
cos” yo = Rev cos” yo 
Le u/Re 





where vo is the initial velocity normalized by Earth’s circular orbit speed. 
Having vé = 1 means the object has enough energy to be able to achieve a 
circular orbit. Having vf > 2 means the the object has exceeded the escape 
velocity and is leaving Earth on either a parabolic or hyperbolic trajectory. 
Using the energy equation at launch conditions and the definition for vo, the 
elliptic semi-major axis a is expressed as 


pa 
— 2-ve 





Finally, using Eq. (8.9), the eccentricity e is expressed in terms of initial launch 


conditions as 
e = 1/1—13(2 — v2) cos? yo 


Using these orbit elements we are able to express cos ~ as 


eae 
cos p = Yo — 28 - 
1 — 1§(2 — v%) cos? yo 


Using standard trigonometric identities, we can convert this expression into 


vg sin 2y0 


sing = ————————— 
2 (2+ 13 (2 — v})(cos 2yo — 1)) 
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Either of these expressions relate initial launch conditions yo and vo to the 
desired semi-range angle y. Note however that while v2 > 2 still math- 
ematically provide corresponding semi-range angles, since escape velocity is 
achieved, this situation corresponds to having the object fly through the Earth 
as is illustrated in the dashed line in Figure 8.8. Having a clear flight path 
is not enforced in these equations and must be checked separately. Combin- 
ing the sin and cos expressions of y, we are able to obtain a very compact 
expression for the semi-range angle.* 


va tan Yo 


1—vé+tan? yo 
Assume that the initial velocity vo is fixed and we intend to maximize the 
range y. After taking the derivative of Eq. (8.85) with respect to yo and 
setting it to zero, we find that the corresponding optimal initial launch angle 


is given through 
1 1 
YWopt = COS a See wy (8.86) 


Note that Eq. (8.86) only provides real answers for 0 < ve <1. The reason 
for this is that once a circularizing orbit speed is achieved, any location on 
Earth could be reached. Maximizing the range for velocities beyond this has 
no meaning. For very small initial velocities we can assume that v@ ~ 0. 
This simplifies Eq. (8.86) to the constant gravity field case and yields the 
well-known optimal launch angles 45 and 135 degrees, depending on which 
direction one is launching the projectile. As vj reaches 1 and the projectile 
achieves Earth’s circularizing orbit speed, any point on Earth can be reached. 
The optimal launch angles for this case are yo being either 0 or 180 degrees. 
The corresponding maximum semi-range angle for a given v@ is is found by 
back substituting yo,,, into Eq. (8.85). 





a 
2/1-“ 


For a given feasible vo and y there are generally two possible initial launch 
angles yo. Solving Eq. (8.85) for yo we find 


tan Ymaz = (8.87) 


t \/vg — 4(1 — v2) tan? 





vo 


tan yo = (8.88) 


2tany 
Only one launch angle exists if the discriminant in Eq. (8.88) is zero. This con- 
dition represents a minimum energy trajectory to achieve the desired range. 
Setting the discriminant equal to zero we are able to retrieve Eq. (8.87). 
Solving this equation for v@ we find an expression for the minimum velocity 
necessary to achieve a given y. 


oe . 2 1 
min = 2tan” yp (= a 1 (8.89) 


For given initial velocities v§ and desired semi-range angles vy, Figure 8.9 
illustrates the various corresponding initial launch angles yo. As v@ increases 
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Figure 8.9: Comparison of Initial Velocities and Corresponding Launch 
Angles for Various Ranges 


up to an value of 1, the corresponding launch angles for maximum range 
decrease from 45 degrees to zero degrees. For vj < 1 there are always two 
possible trajectories for a given velocity, a “high” anda “low” path. However, 
once v@ > 1 the two possible trajectories each lie on opposite sides of the 
Earth. 


The total relative energy of a body is universally expressed from the vis-viva 
equation in Eq. (8.82) as 


2 

Bee (8.90) 
2 - a 

where —2,:/a is referred to as the total energy constant. Observe that elliptic 
orbits with a > 0 have a negative total energy. Parabolic orbits have zero total 
energy since a — oo and hyperbolic orbits with a < 0 have positive orbits. To 
minimize the total energy of an elliptic orbit, the semi-major axis a would need 
to made as small as possible. 


8.4 Classical Solutions 


The previous fundamental integrals are all used to describe the instantaneous 
state of an orbit. What is lacking is a method to determine the location of an ob- 
ject within the orbit itself at any instance of time. This section presents various 
classical solutions to the problem of solving the nonlinear relative differential 
equations of motion in Eq. (8.45). 
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8.4.1 Kepler’s Equation 


To determine the angular orbit position at any instance of time, we rewrite the 
angular momentum expression into a form that can easily be integrated. First, 
a frontal assault to this problem is presented that illustrates why using the true 
anomaly f is not attractive for this task. For the case where no disturbance 
acceleration aq is present, the orbit angular momentum magnitude h is constant 
and f = 6. Using Eq. (8.55) we find 


h=r6=r'f (8.91) 
which is rearranged into the form 
hdt = rdf (8.92) 


Substituting Eqs. (8.6) and (8.65) into the above expression, we find the differ- 
ential equation 


[ df 

—dt = ————_- 8.93 

p (1 + ecos f)? ee) 

which is integrated from the initial time to to another time ¢,. 
fi 

LL df 
—(t; —to) = + 8.94 
E(t ~ te) [ Tesi (8.94) 


The left hand side of Eq. (8.93) is easily be integrated. However, analytically 
solving the right hand side involves finding a solution to a non-standard elliptic 
integral; clearly not a very attractive proposition. By describing the angular 
position within the orbit through the eccentric anomaly F instead of the true 
anomaly f, we are able to replace the differential equation in Eq. (8.93) with an 
equivalent expression which can then be easily integrated. Once again we start 
with the massless angular momentum vector expression 


h=rxr (8.95) 


which is inertially fixed for ag = 0. The position vector r and velocity vector r 
are written in O frame components as 


S.0te Pye, (8.96) 
= be + Yip (8.97) 





since the O frame unit vectors are inertially fixed. Substituting Eqs. (8.96) and 
(8.97) into Eq. (8.95) yields 


h = (xy — y&)in = hah (8.98) 


Substituting the «(£) and y(£) expressions in Eq. (8.16) and (8.17) along with 
their derivatives into the h expression in Eq. (8.98), we find that 


EF 
h=a’v/1 — e? (cos* E + sin? E — ecos E) (8.99) 
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Using the standard trigonometric identity cos? E+sin? E = 1 and Eqs. (8.9) and 
(8.65), we are now able to replace Eq. (8.93) with the more attractive differential 
equation 


Lb 
gat = (1-—ecosE)dE (8.100) 


This differential equation can be rewritten to provide a convenient expression 


for E. 
dE . Lb 1 1 /u 
dt V a3 (1—ecosE) rVa ey) 


Integrating Eq. (8.100) we obtain the famous Kepler’s equation. 


yaath — to) = (E-esin E)|F (8.102) 


Given some initial time tp, eccentric anomaly Eo and a current time t;, Kepler’s 
equation is solved for the current eccentric anomaly EF using a numerical method 
such as Newton’s method. Setting Eo = 0 and Ey = 27 we are able to verify 
the orbit period equation in Eq. (8.68). Let us introduce the mean anomaly M 
as 


M = Mo + n(t — to) (8.103) 
with 0 < M < 27 and the mean angular motion n as 


Lb 27 
n ae P ( ) 
where P is the orbit period, then Kepler’s equation of Eq. (8.102) is written in 
its classical form as 


M= Mo + n(ty 7 to) =H-esin—E (8.105) 


Clearly it is more convenient to use the eccentric or mean anomaly instead of 
the true anomaly to describe a position within the orbit. Using Eq. (8.22) and 
the eccentricity e, the eccentric anomaly EF can always be translated back into 
the true anomaly f if necessary. 


Example 8.4: The following example illustrates how well Newton's method 
is suited to numerically solve Kepler's equation for the eccentric anomaly E 
that corresponds to a given mean anomaly M. Once a mean anomaly M is 
computed using Eq. (8.105) for a given mean angular motion n and time f1, 
we must solve the nonlinear equation 


f(£) =M —-(£-esinE) =0 
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for the corresponding eccentric anomaly E. Given an initial guess E for the 
true &, Newton's method computes the step correction AF through 





__ SB) 
f(£) 
where f’(£) is given by 
f'(B) = a = —(1- ecos E) = ao 
B 


Typically, setting the initial value of E equal to M provides a good starting 
point for the numerical iteration and results in a fast convergence rate. The 
reason for this is evident in Figure 8.10 which compares the mean versus 
the eccentric anomaly for eccentricities ranging from e = 0 (circular case) to 
€ = 1 (parabolic case). For circular or near-circular orbits, assuming M =~ E 
is clearly a very good initial guess. However, even for the limiting parabolic 
case do the eccentric anomalies remain relatively close to the mean anomalies. 
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Figure 8.10: Mean Anomaly versus Eccentric Anomaly for Various Ec- 
centricities 


To demonstrate the good convergence characteristics of Newton’s method, 
we numerically solve for the eccentric anomaly E corresponding to a mean 
anomaly M of 1.5. The eccentricity e is set to 0.8, a rather large, near- 
parabolic value. For near-circular cases with small values of e, Figure 8.10 
already illustrates that M = E. 

Table 8.3 shows the convergence for each iteration step. Even though the 
eccentricity e is rather large, after only three integration steps the eccentric 
anomaly estimate E is already accurate up to 5 significant digits. After 
just two more iteration steps, the estimate is sufficiently accurate for double 
precision arithmetic. 
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Table 8.3: Iteration Steps of Applying Newton’s Method to Numerically 
Solve Kepler’s Equation 


Iteration Step AE E 
0 1.500000000000000 
1 8.45863 1071 —-2.345863185046372 
2 -1.75896 107! —2.169967661788265 
3 -6.42592 1073 ~—-2.163541744525667 
4 -9.44057 10-® =. 2.163532303960638 
5 -2.04353 10°" ~—-2.163532303940202 
6 -1.53462 1071 —.2.163532303940202 


To find Kepler’s equation for a hyperbolic orbit, we substitute the x and y 
definitions in terms of the hyperbolic anomaly H in Eqs. (8.31) and (8.32) along 
with their derivatives 


é = —asinh HH (8.106) 
y = av/e? —1coshHH (8.107) 


into the angular momentum expression in Eq. (8.98). After making use of 
Egs. (8.28) and (8.65), the hyperbolic anomaly derivative is given by 


dH n 1 /u 
dt ecoshH—1 rVa S108) 


Kepler’s equation is then found after separating variables in Eq. (8.108) and 
integrating both sides to be 


n(t — to) = (esinh H — H)|77 = N(t1) — N(to) (8.109) 


where N = esinhH — H is the hyperbolic equivalent of the elliptic mean 
anomaly. 


8.4.2. Orbit Elements 


Given some initial conditions r(tp) and 7(to) and a current time t,, the second 
order relative differential equation of motion in Eq. (8.45) can be solved for any 
current r(t,) and 7(t,) vectors. Note that the six scalar vector components 
of the initial conditions are invariants of the solution, similar to the constant 
fundamental integrals introduced in the previous section. These orbit constants 
determine the size and shape of the orbit trajectory. The time t, indicates where 
an object is within the orbit. 

This behavior is universally true. Any two-body orbit geometry can be 
described through six scalar constants with the body position within the orbit 
described through a time-like variable. Therefore, instead of having six degrees 
of freedom in (8.45), there is really only one degree of freedom in a fixed orbit. By 
choosing other system invariants than r(to) and r(to), the differential equations 
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of motion in Eq. (8.45) can be replaced with simpler expressions For example, 
given the orbit semi-major axis a and eccentricity e, Kepler’s equation replaces 
the second order relative differential equation of motion with a scalar (i.e. one 
degree of freedom), algebraic relationship between the time t; and the mean 
anomaly M. 

The six orbit invariants are called the orbit elements. Any six orbit constants 
can be used for this purpose. A commonly used set of orbit elements are 


{a,e,1,Q,w, Mo} (8.110) 


The first two invariants a and e determine the orbit size and shape. The follow- 
ing three scalars , i and w are the (3-1-3) Euler angles which define the orbit 
plane orientation. Finally, the mean anomaly Mp specifies where the object is 
within the orbit trajectory at time to. To translate r(to) and r(tg) into the orbit 
elements in Eq. (8.110), the following steps are taken. The semi-major axis a is 
found by first finding 


TO = r(to) " r(to) (8.111) 
ve = P(to) - P(to) (8.112) 
and then using the energy equation: 


1 2 ve 


-=— 8.113 
Se a (8.118) 

The eccentricity e is found by first computing the constant vector c 
c= ty x h— po (8.114) 

TO 
and then calculating 
e= al (8.115) 
[Lb 


Let the direction cosine matrix [C] map inertial NV frame vectors into orbit 
frame O vectors. Using Eq. (3.5), the O frame unit vectors are found through 


le => c/pe = City Tr Ciaty Ee C132, (8.116) 
dp = th x le = Coty + Co2ty + C34, (8.117) 
tn =h/h = Carty + Coady + C332 (8.118) 











Given the direction cosine matrix elements, the corresponding (3-1-3) Euler 
angles are found using Eq. (3.36). 





a C31 
Q = tan ( ) 8.119 
Oe ( ) 
i = cos! (C33) (8.120) 


w = tan} (=) (8.121) 
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To find the initial mean anomaly Mo, we define /uo = r-r, so the constant 
00 is 


To: To — Toro 
Oo= = 8.122 
ve ie oe 


Using Eqs. (8.15) and (8.101), oo can also be written as 








oo = Vaesin Eo (8.123) 


However, if Eq. (8.123) were solved directly for Eo, then we would have to deal 
with the quadrant issues of the sin! function. Instead, we use Eqs. (8.15) and 
(8.101)to express the initial eccentric anomaly Eo in terms of oo and ro through 


Eo = tan~} (24) —n<Ey<r (8.124) 
— 10 


By making use of the numerical function tan2(z, y), no quadrant problems arise 
with this formula. The initial mean anomaly is then found through 


Mo = Ey —esin Eo (8.125) 


The reverse process of this orbit element transformation is posed as an exercise 
problem at the end of this chapter. 


Example 8.5: The scalar parameter o(t) is defined through 
o(t) = POO (8.126) 


and provides a measure of orthogonality between the instantaneous position 
and velocity vector. Note that o(t) is zero at apoapses and periapses of 
elliptic orbits and at any point of a circular orbit. The second derivative of o 
assumes a very familiar form. Differentiating o we find 


ss, 
VE fii 


After substituting Eqs. (8.45) and (8.113), the o rate expression reduces to 


ma(E-3) (2 


Differentiating o we find 


pag A ee 


r2 re JE — re JE 


which, after using Eq. (8.126), leads to the familiar algebraic expression 


Pasa? (8.127) 
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Therefore the scalar o differential equation has the same algebraic form as the 
relative equations of motion in Eq. (8.45). Any scalar differential equation 
of the algebraic form given in Eq. (8.127) automatically has a corresponding 
invariant vector. The vector c2, defined through 
Co =Oor—or 
is inertially fixed since 
€2 =or+or—or—or =0 


This fixed vector c2 can be found for any scalar parameter which satisfies 
Eq. (8.127). To geometrically interpret this vector, we perform the dot prod- 
uct of c2 with the position vector r. 


rc) =7- (or —oF) = (ve(=-+)"- 4) 


Evaluating the expression r - (# x A) it can be shown that 





(ré)? = v?r? — h? 


Using this identity and the fact that r-c2 = r|c2| cos(Zr, cz), the orbit radius 
r is expressed as 


n/m 
1+ teal cos(ZTr, C2) 


Comparing this expression to Eq. (8.6), it is evident that c2 must be given by 
C2 = ey/p te 


It is related to the eccentricity vector c in Eq. (8.66) in that it also points 
towards periapses, but has a different vector magnitude. 


Besides the set presented in Eq. (8.110), many other orbit element sets are 
possible. For example, another feasible orbit element set could be given by 


{h,e,Q,i,w, f} (8.128) 


with the true anomaly f acting as the time-like parameter. The orbit shape 
is determined through the parameters h and e. The orbit plane orientation is 
again determined through the (3-1-3) Euler angle set {Q,7,w}. Note that there 
is no sixth parameter explicitly specifying the initial position within the orbit. 
Since f forms in essence our time variable, implicitly when f = 0 then we have 
Mo = Eo = 0. Let the frame M = {7,, %9, 2} have its first direction unit vector 
2, track the position of the body m as shown in Figure 8.7. The relative position 
vector r is expressed in M frame components as 


M 
r 


0 (8.129) 
0 


3 
I 
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The orientation of the M frame relative to the inertial VV frame is given through 
the (3-1-3) Euler angle set {Q,7,0} with 0 = w+ f. Using the (3-1-3) Euler 
angle parameterization of the direction cosine matrix in Eq. (3.35), the inertial 
vector components of the position vector r are given by 


a cos 9 cos 6 — sinQ sin 6 cosi 
r=r | sinQcosé+cosQsin@cosi (8.130) 
sin 6 sinz 


Therefore, given the five constant orbit elements in Eq. (8.128) and a true 
anomaly f, Eq. (8.130) provides the current inertial position vector components 
directly without having to perform any numerical iterations. Kepler’s equa- 
tion is used later to correlate the current f with a corresponding time. Using 
Egs. (8.6) and (8.65), the derivative of Eq. (8.130) is written in the relatively 
simple form 


Neos Q(sin 6 + esinw) + sin Q(cos @ + ecosw) cosi 
r= a sin (sin 0 + esinw) — cos (cos 6 + ecosw) cosé (8.131) 
—(cos @ + ecosw) sini 





Again, given a true anomaly f, the corresponding inertial velocity vector is 
readily computed. 

Given the Eqs. (8.3) and (8.4), the position vector can r is written as a 
direct function of the true anomaly f as 


r=rcos fie+rsin fap (8.132) 


where the unit vectors @. and é, are illustrated in Figure 8.7. Using Eqs. (8.55) 
and (8.65), the velocity vector v is then expressed as a direct function of the 
true anomaly f as 


v= -5 sin fae + =(e + cos ft, (8.133) 


Another popular set of orbit elements is the Delaunay variable set given by 
{l,g,h, L,G, H} (8.134) 


where small letters indicate orientation-type quantities and the capital letters 
represent the corresponding generalized momentas. In terms of the previous 
orbit elements, they are defined as° 

| = Mean Anomaly 

g = Argument of the Pericenter w 

h = Longitude of Ascending Node 2 


L=/Jpa 
G=LvV1-e? = V/pa(1 — e?) = Angular Momentum Magnitude 


HT = Gcosi = Ang. Mom. Component Normal to Equitorial Plane 
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These variables are popular because they are canonical variables that abide by 
the differential equations 


dL OH dl OH 


eae FL (8.135a) 
dG dH dg OH 

a-G 6¢--F (8.135b) 
AON” alee. Ne (8.135¢) 


‘dt Oh dt OH 


Where the scalar 1 is the system Hamiltonian. For a perfectly spherical planet, 
the Hamiltonian of a small satellite orbiting this body is given by 


pe 2 pe 


~ Qa 20? 
The beauty of these variables is that their simple differential equations in 
Eq. (8.135) can easily be modified to encompass situations other than orbits 
about spherical bodies. For example, it is possible to extend the Hamiltonian 
H to incorporate Earth oblateness effects. 

To verify the differential equations of Eq. (8.135), let us verify that all the 
orbit elements except for the mean anomaly / are constant for the case of a 
spherical Earth. Since the Hamiltonian in Eq. (8.136) only depends on L, then 
L, G, H, g and h are zero. The only non-zero quantity is i given by 


fn SOT BE ie 
j---4 = jE=n (8.137) 


which agrees with Kepler’s equation. If oblateness effects were included in the 
Hamiltonian expression, than we would find that other variables would be time 
varying too. 

While the physical interpretations of the classical orbit elements shown in 
Eq. (8.110) are easy to visualize, this set of orbit elements often lead to singular 
equations as the eccentricity to the orbit inclination angle tend to zero. Prof. 
Roger A. Broucke developed a set of orbit elements called the equinoctial vari- 
ables which are non-singular and don’t lead to any mathematical singularities 
for any eccentricity or orbit inclination angle. To do so, we define the longitude 
of pericenter as 


(8.136) 


w=wtQ (8.138) 


Instead of using the mean or true anomaly as the time dependent quantity, the 
mean longitude V is used instead. The mean longitude is defined here as the 
sum of the argument of perigee, ascending node and the mean anomaly. 


V=wt0N4+M=a+M (8.139) 
The equinoctial element set is given by the parameters 


{a, P,, Pe, Qi, Q2, 0} (8.140) 
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where the elements P; and Q; are defined in terms of the classical orbit elements 
as 


P, =esinw P2 =ecosw (8.141) 


Q) = tan 5 sin Q Qo = tan 5 cos 2 (8.142) 


The inverse transformation is given by 


e= 4/P? + P? (8.143) 


i= 2tan7' (Q7+ Q3) (8.144) 
@=tan! (=) (8.145) 
Q=tan7! (#) (8.146) 
M=%8-tan™ (=) (8.147) 


8.4.3 Lagrange/Gibbs F and G Solution 


The orbit plane is defined through the two initial condition vectors r(to) and 
r(to) as shown in Figure 8.11. Since any orbit position vector r(t) and ve- 
locity vector 7(t) will lie in the orbit plane, they can be expressed as a linear 
combination of the initial condition vectors as 


r(t) = Fr(to) + Gr(to) (8.148) 
7r(t) = Fr(to) + Gr(to) (8.149) 





where F' and G are yet to be determined functions. Substituting Eqs. (8.148) 
and (8.149) into the relative differential equations of motion in Eq. (8.45) and 
making use of the fact that the initial position and velocity vectors are arbitrary, 
one immediate property of these functions is found to be 


Fo —5F (8.150) 
G= -56 (8.151) 
with the initial conditions being 
F(t))=1 F(t) =0 (8.152) 
Gt.) =0 Gt) =1 (8.153) 


Note that the second order differential equations for both F' and G have the 
same algebraic form as the relative equations of motion. 
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F(t) 


r(t) 


Figure 8.11: Orbit Plane Illustration 


A brute force approach to solving for the F’ and G functions would be to 
attempt a power series solution of the form 


(t = to)” dr 


r(t) =r(to) + >) ——— 


aa ar i (8.154) 
Battin shows in Ref. 2 that it is indeed possible to find an algebraic recursive 
solution for the power series coefficients. While the development of this method 
yields many interesting insights, the power series solution has the drawback of 
having a slow convergence rate and has therefore less practical value. Instead, 
the following method provides exact analytic expressions for both F and G 
for arbitrary (t — to). Using the O frame position vector components (x, y) in 
Eq. (8.96), we can write Eq. (8.148) as 


(i) = [ies] (@) ee 


Solving Eq. (8.155) for F and G we find 


1 ; 3 
()-ratmlt IG) em 
G (xoyo — yoto) |~Yo %o | \Y 
Using Eqs. (8.65) and (8.98), the determinant is rewritten as 
XoYyo = yoXo — 9 V Lp (8.157) 


Therefore the F' and G functions are given explicitly through 


F= Flin =i (8.158) 
GS = Gea) (8.159) 


Vip 
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In Eqs. (8.16) and (8.17) we have already found expressions of position vector 
orbit plane components x and y in terms of the orbit elements a, e and the 
eccentric anomaly EF. This allows us to find analytical expressions of F' and G 
in terms of E. Using the EF expression in Eq. (8.101), the velocity components 
« and y are found to be 





¢ = —V" sink (8.160) 
Tr 
— 2, 
fa Ae ee (8.161) 
5 


Upon substituting Eqs. (8.16), (8.17), (8.160) and (8.161) into Eq. (8.156) we 
find the desired exact, analytical solution of the function F' to be 


Pe ge = toek (8.162) 
TO 


where EF = E — Ep is defined as the change in eccentric anomaly. Using similar 
steps, the function G is expressed at first as 


Bie) we 
Gay) = [sin B - e(sin E — sin Ep) (8.163) 
LL 


To write the second part of the above expression in terms of E instead of E and 
Fo, Kepler’s equation is written at time t and to as 


M=M)+,/40@-t)=E-esinE (8.164) 
a 
Mo = Eo —esin Eo (8.165) 
Subtracting one equation from the other leads to the expression 
—e(sin EB — sin Ey) = ,f E(t — to) — B (8.166) 
a 


which allows G to be written in the final form 


a? ae 
G=(t-t)+4/— (sin B - £) (8.167) 
LL 


The next step is to find analytical expressions for F and G. Using the E 
expression in Eq. (8.101), Eqs. (8.162) and (8.167) are differentiated to yield 





pac ae (8.168) 


rro 


GS 2 c6eP) (8.169) 
r 
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Since and F and G functions along with their derivatives are written in terms 
of EB, we would like to write the current orbit radius r, which appears in 
Eqs. (8.168) and (8.169), also in terms of E. Substituting the trigonometric 
identity 


cos E = cos Ey cos E — sin Ey sin E (8.170) 
into Eq. (8.15) we find 


r= a(1—ecos Ey cos & + esin Ey sin B) (8.171) 


Using Eqs. (8.15) and (8.122), r = r(£) is written as 
r=a+(ro — a) cosE+ Vaoo sin E (8.172) 
To find a “modified” Kepler’s equation in terms of EB, we recognize first that 


dE ~ 1 fp 
— — E = — wl 
dt rVa ere) 


After separating variables, this leads to 


{ea =rdE (8.174) 
a 


Substituting Eq. (8.172) and diving both sides by a leads to the perfect differ- 


ential equation 
\/ dt = (1-1 2)cos B+ “sin £) dE (8.175) 
a a Ja 


Integrating this equation leads to the desired “modified” Kepler’s equation 


i= J H(t— to) = B= B)sinB- B(cos -1) (8.176) 


The F and G solution provided in Eqs. (8.148) and (8.149) provide a direct 
mapping of the initial position and velocity vectors into corresponding vectors 
at the current time t. Note that the inverse transformation is provided by the 
remarkably simple expression: 


r(to) = Gr(t) — Gr(t) (8.177) 
(to) = —Fr(t) + Fr(t) (8.178) 


This inverse mapping is achieved using the F' and G solution property 


FG-GF=0 (8.179) 
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This property can be verified by back substituting the expressions found for F 
and G, along with their derivatives. 

Another useful form of the F’ and G solution is to express the solution in 
terms of a true anomaly difference f = f— fo. To make use of the expressions for 
F and G in Egs. (8.158) and (8.159), we write the position vector r(t) velocity 
vector r(t) as 





r=rcos fi, -rsin ft, (8.180) 
——” —— 
x y 
hsi h 
pct ee ees ea) ip (8.181) 
ee ee 
& y 


with the orbit radius rate * being given by 
. hesin f 
T= -_o 

Pp 


Substituting Eq. (8.180) and (8.181) into Eqs. (8.158) and (8.159) and simpli- 
fying using trigonometric identities yields? 


(8.182) 


Si , (1 — cos f) (8.183) 

G= = sin f (8.184) 
Substituting Eqs. (8.180) and (8.181) into Eq. (8.122), the parameter a is given 
by 


r-r hresinf — resin f 
COS aS ES ees 
VE VEEP vP 


Differentiating the F and G expressions in Eqs. (8.183) and (8.184) with respect 
to time and making use of the o expression, the F' and G are found to be 





(8.185) 


F= _ G (1 — cos f) + ypsin f) (8.186) 
Gaia (1 — cos f) (8.187) 
Pp 


The orbit radius is expressed in terms of f through the orbit equation 


P 


—————— (8.188) 
1+ ecos(fo + f) 


Expanding the cos term and making use of the o definition and the fact that 
ro = p/(1 + ecos fo), the orbit radius can also be written in the form? 


PTO 


SS (8.189) 
ro + (p— ro) cos f — ,/poo sin f 


— 
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Using Eq. (8.185) we can relative the o parameters at time to and t through 


o 00 * sin f 
— = — cos — (p- wl 
coal cos f + FogE (p — 10) (8.190) 


Substituting Eqs. (8.189) and (8.190) into Eq. (8.186), we are able to express 
the F rate expression in terms of initial states states only.? 


pas (oo(1 — cos f) — vpsin f) (8.191) 
Trop 
Problems 
8.1 Integrate Kepler’s second law in Example 8.1 directly without using the geomet- 


rical insight that the right hand side computes the area of an ellipse. 


8.2 Starting with Eqs. (8.18) and (8.19), derive the partial derivative expression of 
f with respect to FE given by 
Of b 
=: 8.192 
OE r ( ) 
8.3 Specify the steps necessary to translate the six orbit elements in Eq. (8.110) given 
at time t1 into the corresponding inertial position and velocity vectors r(t1) and 


P(t1). 


8.4 Verify that Eq. (8.131) is indeed the derivative of Eq. (8.130). 





interior chase \ exterior chase,” 
orbit ‘SO orbit Bee 
(i) Interior Chase Orbit (ii) Exterior Chase Orbit 


Figure 8.12: Illustration of Two Rendezvous Chase Orbit Options. 
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8.6 


8.7 
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Consider two spacecraft (A and B) in the same circular orbit of radius a. Space- 
craft B is initially 0 radians of true anomaly ahead of A. It is desired that the 
spacecraft A "catch up” (or rendezvous) with B by transferring temporarily onto 
a” chase” orbit, then transferring back onto the original circular orbit. Referring 
to Figure 8.12, two options are being considered: 

Option 1: Use an Interior Orbit Spacecraft A decreases its velocity (by 
amount Avz), so that it transfers at apogee onto a judicious chase orbit. Upon 
return to apogee, it increases its velocity by Av; to rendezvous with spacecraft 
B and maintain again a circular orbit of radius a. 

Option 2: Use an Exterior Orbit Spacecraft A increases its velocity (by 
an amount Avz2), so that it transfers at perigee onto a judicious chase orbit. 
Upon returning to perigee, it decreases its velocity by Av2 to rendezvous with 
spacecraft B. 

Assume all velocity changes are instantaneous and tangential to the orbit. As- 
sume rendezvous occurs, for both options, after one orbit of A on the chase 
orbit. 


a) Determine the required velocity increments (Avi and Avz) as functions 
of a, 8 and uw 


b) Discuss the relative advantages of these two options, and also discuss any 
circumstances which would make the solutions unfeasible. 


Write subroutines that map between Cartesian orbit position coordinates and the 
orbit element set shown in Eq. (8.110) using the following steps. 


a) Write a subroutine that maps the Cartesian position and velocity coor- 
dinates of a spacecraft to the corresponding orbit elements and current 
mean anomaly. 


b) Write a subroutine that maps current orbit elements and time since last 
perigee passage to corresponding Cartesian position and velocity coordi- 
nates. Verify that this numerical mapping is the precise inverse of task 
a). 

c) Write a numerical simulation that integrates the differential equations of 
motion in Eq. (8.45) using a 4-th order Runge Kutta integration scheme. 
Using the subroutine of task b), compare the answer of the numerical 
integration to the analytical two-body solution. 


Program the F and G solution to the two-body problem. Verify the answer by 
comparing it to a numerical integration of the differential equations of motion in 
Eq. (8.45). 


Consider the two-body equations of motion in Eq. (8.45) and the F and G 
solution in Eqs. (8.148) and (8.149). 


a) Prove that F and G satisfy F = —p/r?F and G = —p/r°G. 


b) Prove that H = FG— GF is a constant of the solution. Evaluate H as a 
function of the initial conditions. 
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CHAPTER NINE 


Restricted Three-Body 
Problem 





HILE the Keplerian two-body problem has a very elegant analytical solu- 

tion, the general three-body problem increases the level of complexity to 
such a degree to make an analytical solution intractable. While no general solu- 
tions exist for this 18-th order system, ten exact analytical integrals are possible 
for the general case, corresponding to conservation of angular momentum (3 in- 
tegrals), energy (1 integral), and motion of the system mass center (6 integrals). 
These ten integrals, together with imposing other special case conditions, per- 
mit considerable additional analytical progress to be made. Virtually all of this 
progress stems from the work of the brilliant French astronomer and mathemati- 
cian, Lagrange. A familiar three-body problem is the Sun-Earth-Moon system. 
While the moon does orbit the Earth in a near-elliptical manner, to account 
for some of the deviations of its orbit relative to Earth, the gravitational effect 
of the sun must also be taken into account. This is one reason why a precise 
description of the lunar orbit is very complicated. 

While Newton was the first to study the combined motion of several celestial 
objects accounting for their mutual gravitational attraction, it was Lagrange in 
1772 who submitted his memoir Essai sur le Probléme des Trois Corps to the 
Paris Academy that demonstrated analytical solutions do exist for the three- 
body problem if certain restrictions are imposed. These restrictions force the 
three bodies to remain in an equilateral triangle or collinear formation. This 
chapter studies these motions and shows their properties. Of particular interest 
is the circular restricted three-body problem. Here two larger, spherical bodies 
are restricted to follow a circular, Keplerian motion, while a third body of 
relatively infinitesimal mass is moving among them in a general fashion. A 
good way to visualize this is to think of the Apollo program where a small 
space vehicle is flying under the gravitational influence of the uniformly rotating 
Earth-Moon system. 
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Figure 9.1: Illustration of Three-Body Problem 


9.1 Lagrange’s Three-Body Solution 


Lagrange showed that it is possible to find solutions of the three-body problem 
where the shape of the three-body formation does not change in time. First, 
the more general case is studied where the size or orientation of the fixed three- 
body formation is free to vary with time. Then, the special case is studied where 
all three bodies are assumed to rotate about their center of mass at a common 
angular rate. In both studies the mass of each body is assumed to be sufficiently 
large to affect the motion of the remaining two bodies. 


9.1.1 General Conic Solutions 


Assume the position of the three masses m1, m2 and m3 are located relative to 
their center of mass through the vectors ri, rg and r3 as shown in Figure 9.1. 
Since external forces are neglected, we find 


MPF. = Festernal © 0 (9.1) 
where the total system mass M is defined as 
M = My + ms + m3, (9.2) 


and r, is the inertial position vector of the system center of mass. We see 
that the motion of the mass center is a constant velocity straight line motion. 
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Since 7, = 0, we adopt the center of mass as an inertial origin, then the three 
equations of motion are given by 





3 
mij =GS Ee =F fori=l,2,3 145 (9.3) 
j=l 4 


where G is the universal gravitational constant, F; is the net resultant force 
acting on each mass m;, ri; is the relative position vector defined as 


Pig =U Th (9.4) 
and the scalar distances rj; are computed as 
Tig = l= JTig Pig (9.5) 


Since the position vectors r; are defined relative to the center of mass, then 
according to Eq. (2.43) 


M1, + Me%2 + M3r3 = 0 (9.6) 


must be true. Using Eq. (9.2) and adding and subtracting appropriate terms, 
Eq. (9.6) is written in three different forms: 


Mr, = —M2P7 12 — M313 (9.7a) 
Mro = M1712 — M33 (9.7b) 
Mrz = M1713 + M223 (9.7c) 


Squaring these equations we find the following useful scalar relationships 


2.2 2.2 2,2 

M*ry = Mgrjg + M3rz3 + 2MeMsri2 - 113 (9.8a) 
2,2 2.2 2,2 

Mrz = M{rj2 + M3r93 — 2M MsZP12 - 723 (9.8b) 
BO ai 8 2,2 

M*r3 = Myrj3 + MZrg3 + 2MiMeP13 - 123 (9.8c) 








Following Lagrange’s historic conjectures, the key assumption in this develop- 
ment is that we are seeking solutions to the three-body problem which retain the 
shape of the original three-body configuration. For this to be true, the three 
relative distances r12, T23 and 713 must all evolve in the same manner. Let 
f(t) be some generic time varying function with f(0) = 1. Then the relative 
distances rj; must satisfy 











rig _ 713 _ 723 = f(t) (9.9) 
T1206 T1390 1230 


where rj. is the initial relative distance. Since the formation shape is fixed, 
the angles a; between the relative distance vectors are constant. Substituting 
Eq. (9.9) into (9.8a) we find 


M?r? = f(t)? (m5rio, + m3ris, + 2m2M3P1291135 COS a) (9.10) 
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Since f(0) = 1, we are able to express r1, as 


jr) 20 2.2 
M5rig, + M3Ti3, + 22M3T125T139 COS Q1 ais 


ao M 


Eq. (9.11) is alternatively derived immediately from Eq. (9.8a) by applying 
initial conditions. Using this definition in Eq. (9.10), we are able to express 
r1(t) as 


ry(t) = ri) f(t) (9.12) 


This states that the radial distance of the mass to the center of mass will evolve 
in the same manner as the relative distances. Similarly, we can express the other 
two radial distances as 


T2 (t) = o,f (#) (9.13) 
r3(t) = 73) f(t) (9.14) 


Since the three-body configuration shape must remain invariant, all three an- 
gular velocity vectors must be equal (but not necessarily constant): 


Wy = WQ = W3 = WS wé3 (9.15) 


The angular momentum vector H of the general three-body system about 
the center of mass is constant for this zero-external force system and is defined 
as 


3 
H= Sori xX Mir; = constant (9.16) 


i=1 


It is convenient to simplify the discussion by introducing a fundamental invariant 
plane whose normal is the constant angular momentum vector H. If we further 
restrict attention to the case that all three sets of position and velocity vectors 
lie in this invariant plane at some initial instant, then the motion of (m1, mo, 
mz) will remain co-planar forever, because all of the forces can be shown to lie in 
this same plane. Therefore we are able to treat this shape invariant three-body 
problem as a planar motion problem. Expressing the position vectors r; and 
velocity vectors r; components in rotating reference frames €; = {é,,, €9,, 63, } 
shown in Figure 9.1, we find 


Ti = Ti€p, (9.17) 
F, = (Fj — ryw)é,, + (Qryw + rw) eo, (9.19) 


Using Eqs. (9.12) through (9.15), we write the angular momentum vector as 


H= 


3 
i= 


(mir?) frwés (9.20) 
1 
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Because H is constant, Eq. (9.20) implies that the product f?(t)w(t) must also 
be constant. Since the angular momentum vector of each particle is given by 


Hi; =7; Xx Mir; = mir; f wes (9.21) 


this implies that the angular momentum of each mass m, is also constant. Tak- 
ing the derivative of the constant vector H; we find 


H; =7,X Mr; =7; X F; =0 (9.22) 


The resulting condition r; x 7; dictates that the acceleration vector 7;, and 
therefore also the +th net force vector F;, must be parallel at all times to the 
radial position vector r;. The conclusion is one condition for the three-body 
configuration shape to remain fixed is that the resultant force vector F; on each 
mass must be a radial force passing through the system center of mass, and can 
be written as 


F, = Fé, (9.23) 


Substituting Eq. (9.19) and (9.23) into the equations motion in Eq. (9.3) we 
find 


F, = mj(*; — riw) (9.24) 


Using Eqs. (9.12)-(9.14) this is rewritten as 


F; ee 2 
— = fri, —Tiw = 7; 


M4 


- .) (9.25) 


SIS 


Rearranging Eq. (9.25) we find 


Hoof. w? = A(t) (9.26) 


MGiTy f 





which states that the ratio of the net resultant force over the radial distance to 
the center of mass and body mass m, will remain the same for all three masses. 
Therefore 


The condition in Eq. (9.22) requires that r; x 7; = 0. As we will show next, 
this is only possible for our restricted three-body system for two types of con- 
figurations. Setting i = 1 in Eq. (9.3) and taking its cross product with r; leads 
to 


T1 xX (mez + ms) =0 (9.28) 
"12 "13 
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The center of mass definition in Eq. (9.6) is rewritten as 
M3°r3 = —M 17, — MP2 (9.29) 


Substituting Eq. (9.29) into (9.28) leads to the condition 


1 1 
mor, X T2 (= => =) =0 (9.30) 
Ti2 13 


Similarly, for the other two cases we find the necessary conditions 


sep ( Big ) 0 (9.31) 
my1P2 3, 3-7 a3] = . 
33 Tee 
1 1 
M373 X T1 Poo ag 0 (9.32) 
T1393 


There are only two geometric configurations that satisfy Eqs. (9.30)-(9.32). The 
first configuration found by Lagrange is that of an equilateral triangle since 


r12 =1723 =T13 = p (9.33) 


The second possible configuration has all three bodies on a straight line in a 
collinear formation: 


T,X %T2=72 X73 =73 XT, =0 (9.34) 


It is remarkable to note that these are the only two possible three-body config- 
urations which will maintain constant formation shapes. The necessary initial 
conditions for the three-body motion to be shape-invariant are summarized as: 


1. The net resultant force Fj; on each mass must pass through the system 
center of mass. 


2. The net resultant force F; is along the radial vector locating each mass 
relative to the system center of mass. 


3. The initial velocity vectors are proportional in magnitude to the respective 
distances of the masses to the system center of mass. 


4. The initial velocity vectors make equal angles with the radial position 
vectors to the system center of mass 


Equilateral Triangle Solution 


Again, following the insights of Lagrange, we investigate the special case in 
which the masses lie at the vertices of a rotating equilateral triangle. For this 
case, the equations of motion of each individual mass take on a surprisingly sim- 
ple and familiar form. We note for the most general class of equilateral motions, 
the triangle is rotating at some variable angular velocity (to be determined) and 
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the size of the equilateral triangle may be time varying. Substituting Eq. (9.33) 
into the three-body equations of motion in Eq. (9.3) we find the general form 














a Gm 

mir, = zB (meri + m3P13) (9.35a) 
2 Gm 

Me2P2 = BB =(—miriz + m3r2s) (9.35b) 
% Gm 

M3°r3 = — a 2 (mir13 are M2123) (9.35c) 


Substituting the center of mass conditions in Eq. (9.7), these equations of motion 
are written compactly as 


GM 
H+ r,=0  fori=1,2,3 (9.36) 
p 


Specializing these general equations in Eq. (9.35), we make use of the fact that 
for the equilateral triangle special class of motions a; = a3 = 60° and az = 120° 
and substitute Eqs. (9.8), the three equations of motion can be written in the 
decoupled form as 


GM; es i 
®t tr, =%4+4r,=0 fori =1,2,3 (9.37) 
"% " 


with the equivalent effective masses M; defined as 

















1 

My = F753 (m3 m3 + mgm3)°/? (9.38) 
1 

Ma = zqa (ni + mg + mums)?” (9.39) 
1 

Ms = Fag (mi m3 +m m2)?/? (9.40) 


and pu; = GM;. Note that the equations of motion in Eq. (9.37) are of the iden- 
tical form as the relative, two-body equations of motion derived in Eq. (8.45). 
This implies that for the equilateral triangle three-body solution, each mass 
body behaves as if it were only attracted by a mass M; placed at the center of 
mass of the system. Whether these orbits are elliptical, parabolic or hyperbolic 
depends on the energy of the system. 


Example 9.1: To illustrate the general equilateral solution of the three-body 
problem, the motion of the following three-body system is numerically solved 
using Eq. (9.37). The masses are m1 = 5.967 107%kg (1/10th of Earth’s 
mass), m2 = 7.35 10°’kg (Moon’s mass) and m3 = 3.675 10°’kg (half of 
Moon's mass). Each side of the equilateral triangle has an initial length of 
10°m. The initial velocity vector of each mass forms a 40° angle with the 
respective radial position vector and has the magnitudes |7*1| = 29.8659m/s, 
|P2| = 189.181m/s and |#3| = 195.552m/s. The resulting motion is shown 
in Figure 9.2 has seen by a non-rotating frame. 
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Initial Triangle 
Body Formation 


Orbit of m, 





’ Center of Mass 


Figure 9.2: Illustration of General Equilateral Triangle Solution of the 
Three-Body Problem 


The triangular configuration is highlighted at the initial time and at another 
time during the motion. Clearly the shape of the equilateral triangle is invari- 
ant, while its size and orientation changes with time. With the given initial 
energy, each mass follows an elliptic orbit with the system center of mass 
located on one of its foci. 


Collinear Solution 


The second invariant shape of the three-body problem is that of a straight line. 
Here the ratio of the distances between the bodies remains constant. Assuming 
the three bodies are aligned along a rotating straight line, then the rotating é,, 
vectors will be collinear. The three position vectors r; are now given by 


re=aé, fori=1,2,3 (9.41) 


Substituting these specific position vectors into the equations of motion, Eq. (9.3) 
and making use of Eqs. (9.23) and (9.27), the scalar force components F; are 
expressed as 
rg—-2 t3—-2 
Fi = Axim = mym2——— + mym3——— (9.42) 
12 v13 
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v3 — %2 vQ— 2 
ge 8 
93 T19 
U3 — Ly 3 — % 
— M2™M3 
3 3 
T13 093 


Fy = Azam = mM2™Ms3 (9.43) 














Fs = Az3m3 = —M1MNZ3 (9.44) 


where A was previously found to be a scalar quantity common to all three 
bodies. Note that since r;(t) = ri, f(t), then 


me oo (9.45) 
Since f is proportional to the radial distance to the center of mass, each mass 
is subject to an inverse-square-law attraction and therefore describes elliptic, 
parabolic or hyperbolic trajectories.! These three equations in (9.42) through 
(9.44) must be solved for the relative distances 212, 213 and x23. The order 
of the particles within the line is arbitrary and three configurations 123, 132 
and 312 are possible. We will solve for the relative distances for the first case 
which is illustrated in Figure 9.3. The second and third case solutions can be 
found by appropriately rearranging the indices, since the choice of these labels 
is obviously arbitrary. 


m 
; - 1 Center of Mass m ay 
x 2 3 








Figure 9.3: Collinear Three-Body Sequence Illustration 


To simplify solving for the relative distances, the scalar quantity y is intro- 
duced as 
_ %3 — £2 123 


XY = = (9.46) 


TQ — L X12 
Note that 


ES Siang (9.47) 
212 


Observe, if any of the distances (212,213,223) are known, then finding x de- 
termines the system configuration. Subtracting Eq. (9.43) from (9.42) and 
Eq. (9.44) from (9.43) yields 








+ 1 1 

Axi2 = Se + m3 i= = =) (9.48) 
U2 93 hy 
+ 1 1 

Ax3 = ge +My (> = =) (9.49) 
U3 v9 hy 
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Substituting the definition of . we are able to rearrange these two equations 
into the forms 





1 1 
3 
Ax}y = —(mi + mz) + ms (= > re =) (9.50) 
Dee ie (2 ee (9.51) 
i 2 3)8 SD amer ay 


Equating Eqs. (9.50) and (9.51), Lagrange’s famous quintic equation for the 
admissible configuration is found: 


(my + m2)x° + (3m, + 2m2)x* + (3m1 + m2)x? 
_ (me + 3m3)x” = (2me + 3m3)X _ (me + m3) =0 (9.52) 


Since the polynomial coefficients only change sign once, so there is only one 
positive real root to this fifth-order polynomial equation. Therefore Eq. (9.52) 
uniquely defines the relative distances of the three bodies. Given x and one of 
the relative distances between two bodies, the remaining two relative distances 
can be computed using Eqs. (9.46) and (9.47). 


Example 9.2: To illustrate the general invariant collinear three-body solu- 
tion, the three-body system from Example 9.1 is used with a different initial 
configuration. With the specified masses, solving Lagrange’s quintic equation 
for scalar parameter y we find 


x = 0.451027 


The scalar distance x12 is chosen to be 10°m. Using Eqs. (9.46) and (9.47), 
the other two relative distances are 


x23 = 4.510273 10°m 
213 = 1.451027 10°m 


Each velocity vector initially forms a 40° angle with the respective radial 
position vector from the system center of mass. The initial speeds are |7*1| = 
32.9901m/s, |%2| = 150.903m/s and |r3| = 233.844m/s. The resulting 
motion is shown in Figure 9.4 as seen by a non-rotating reference frame. 
The collinear three-body configuration is highlighted at three distinct times. 
As predicted, the ratios of the relative distances remain the same, while the 
size and orientation of the configuration varies with time. With the given 
initial energy, all three orbits are elliptical. Again the system center of mass 
lies in the common foci of each ellipse. The geometric size of each orbit 
in these three-body problems is always an indication of the mass of that 
particular object. In this setting, the first mass m1 is the most massive 
object. Therefore the center of mass point is located close to it and its 
trajectory describes the smallest ellipse about this point. On the other end 
of the spectrum, the mass ms3 is the lightest of the three and is therefore the 
furthest removed from the center of mass and with the largest elliptic orbit. 
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Figure 9.4: Illustration of General Invariant Collinear Solution of the 
Three-Body Problem 


9.1.2 Circular Orbits 


Instead of allowing the three orbits to be either elliptical, parabolic or hyper- 
bolic, we now constrain them to be circular. For the three-body configuration 
shape to remain invariant under this condition, all three orbits must have the 
same constant angular velocity vector w. The three bodies will now move in 
coplanar orbits with the orbit center being the system center of mass. Since this 
is a special case of the general conic orbit solutions, the invariant three-body 
configuration shapes will again be the equilateral triangle and collinear forma- 
tions. Because the orbit radius r; is now fixed, Eq. (9.24) shows that the scalar 
gravitational force F; must equal the mass times the centrifugal acceleration. 


F; = —myrjw (9.53) 


We now derive specific conditions that must be met for such shape-invariant, 
circular three-body orbits to exist. Note that since the three-body formation 
shape will not grow with circular orbits, the masses m,; will appear to remain 
fixed when viewed from a frame rotating with an angular velocity w. These 
specific mass locations are also referred to as stationary points of Lagrange’s 
restricted three-body problem. As is seen later, examining these points is very 
useful when studying spacecraft orbits in the vicinity of two massive celestial 
bodies. 

The three differential equations in Eq. (9.3) define the motion of any three- 
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body system. We are able to eliminate one second order differential equation by 
making use of the center of mass condition in Eq. (9.6). Substituting Eq. (9.53) 
into Eq. (9.3) we find the following three algebraic equations which must hold 
when all three orbits are circular. 


(4-2-4) me ma 
G Ti2 en Ti2 Hs. ry 0 
2 
Ww m m m r — 0 . 
= (+ a al 142.) = 7 (9.54) 
43 12 Fog Fea r3 0 
my m2 m3 
a 
[B] 


For non-trivial solutions to exist, the determinant of [B] must be equal to zero. 
Setting rj2 = 113 = re3 = p for the equilateral triangle case, the determinant of 
[B] is found to be of the remarkably simple form 


2 


Ww m 
Setting this determinant equal to zero, the following necessary condition is found 
for the equilateral triangle shaped three-body configuration to maintain circular 
orbits about the system mass center: 


pow? =GM (9.56) 


This equation is a close cousin to Kepler’s third law of planetary motion. In 
fact, if we set m3 equal to zero, then we obtain the same circular orbit angular 
velocity as is found studying Keplerian motion. Computing the orbit Period P 
for any of our three bodies we find 
p 
P=274/ =— 9.57 
"V GM ee 
By substituting Eq. (9.53) into (9.36) the same circular orbit condition is ob- 
tained from the more general conic formulation. This illustrates that the current 
development is a special case of the more general conic development, and that 
both are closely related to the corresponding Keplerian motion results. 


Example 9.3: The numerical simulation in Example 9.1 is repeated with 
almost identical initial conditions. The only difference is that the angle of 
the initial velocity vector to the radial position vectors to the center of mass 
is now uniformly 90°. The velocities chosen in Example 9.1 were such that 
the necessary condition in Eq. (9.56) is satisfied. By having all initial velocity 
vectors be normal to the position vectors, circular orbits are achieved instead 
of elliptical orbits. The resulting motion is shown in Figure 9.5 as seen by a 
non-rotating coordinate frame. 

With these initial conditions, the equilateral triangle shape of the three-body 
configuration rotates with a constant angular rate w, but remains fixed in size. 
If the motion were shown as seen by a frame rotating with an angular rate 
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Figure 9.5: Illustration of Equilateral Triangle Solution of the Three- 
Body Problem with Circular Orbits 


w, the equilateral triangle would appear fixed in both size and orientation. 
Studying the three-body dynamics as seen in the rotating frame can be quite 
useful and is done extensively in the next section. 


To find the collinear solution for the circular orbit case, we write the three 
position vectors as 


ry = 1é, (9.58a) 
r2 = (#1 + L12)é> (9.58b) 
73 = (41 + L12 + 223) é, (9.58c) 





where the masses are aligned as was done in the general conic orbit development 
in Figure 9.3. Note that the scalar position coordinate x1 of the first mass 
relative to the system center of mass is a negative quantity in this setting. In the 
following development, we seek expressions to solve for the geometric quantities 
x1 and #93 and the kinetic quantity w?, while assuming that the relative distance 
X 2 between the first and second mass is given. In essence, given a two-body 
problem consisting of m,; and mz, we are seeking to determine where we need to 
place the third mass relative to the second mass such that the new three-body 
system will maintain circular orbits about the center of mass with an invariant 
collinear mass configuration. Instead of placing the third mass, we could just as 
easily have chosen to place the first or second mass. Substituting the definitions 
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in Eq. (9.58) into Eq. (9.54), the following three scalar equations are found: 


w? mg m3, 


Bp ae es A) 9.59a 
Get tig (12 + £23)? ( 
we? my M3 
Sa ei bei) a SO (9.59b) 
G Lip X3e 

May, +mer12+ m3(212 + £23) =0 (9.59c) 


As is the case in solving the general collinear solution, it is convenient to rewrite 
these equations in terms of the scalar quantity . defined in Eq. (9.46). Making 
use of this definition, the three scalar equations are written as 





2 
Ww 2 m3, os 
Gtr +m + +02 > 0 (9.60a) 
w m 
Gria(t + 2X1) —m+ a =0 (9.60b) 
M 
ath Fm + (1+ x)m3 =0 (9.60c) 
12 


Recall that the relative distance x12 is assumed to be a fixed parameter. There- 
fore Eq. (9.60a) can be solved directly for the necessary angular velocity mag- 
nitude w in terms of x. 


GM 1 2 
es ; : ma(1 + x)* + ms (9.61) 
Tig(1+ x)? mo+(1+x)ms 
Note that if mg is set to zero, then the standard two-body circular orbit speed 
condition is retrieved. The orbit Period P for this configuration is given by 


rij(1+ x)? mo+(1+x)ms 


P=2 Sy ERE Se 
e GM mo(1+x)?+m3 


(9.62) 


Eq. (9.60a) provides an expression for the radial distance x, of the mass m, 
relative to the system center of mass in terms of x. 


xy = —S2 (ma + (1+ x)ms) (9.63) 


Substituting Eqs. (9.61) and (9.63) into Eq. (9.60b) leads us back to Lagrange’s 
quintic polynomial equation provided Eq. (9.52). Given the three masses m1, 
mz and m3, this polynomial is solved numerically for its one real root. Given 
x, we are then able to compute the remaining x; and x23 quantities. 


Example 9.4: The numerical simulation in Example 9.2 is repeated with 
slightly different initial conditions. The angle of the initial velocity vector 
relative to the radial position vectors from the center of mass is now uniformly 
90°. The velocities chosen in Example 9.2 were such that the necessary 
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Figure 9.6: Illustration of Collinear Solutions of the Three-Body Prob- 
lem with Circular Orbits 


condition in Eq. (9.61) is satisfied. The resulting motion is shown Figure 9.6 
as seen by a non-rotating coordinate frame. 

Clearly the initially collinear three-body formation remains collinear with these 
initial conditions. As seen by a reference frame rotating with an angular 
velocity w, all three masses would appear to remain stationary along a straight 
line. Figure 9.6(ii) shows a similar configuration where m3 is placed on the 
far side of m1. Since mj is much larger than both m2 and mz, its orbits is 
a tight circle about the center of mass point. 


9.2 Circular Restricted Three-Body Problem 


In the circular restricted three-body problem we assume that both m, and m2 
are very massive objects compared to the third mass m3. In this restricted 
problem, the Keplerian motion of the first two masses is determined through 
their respective inverse-square gravitational attraction by neglecting the effect 
of the relatively small third mass on the first two masses. From here on, we will 
drop the letter “3” subscript on the small mass and simply call it m. Therefore 
the masses m, and mz affect the motion of m, without in return being affected 
by m themselves. The bodies m, and mg are assumed be in circular orbits 
about their mutual center of mass. This is a good approximation for several 
celestial couples like Earth-Moon, Sun-Earth, Sun-Jupiter, ... The small mass 
m could then be the Apollo spacecraft flying between Earth and Moon or some 
asteroids moving under the influence of the sun and some planet. 

For bodies in circular orbits about the system center of mass, Lagrange 
found five distinct three-body formations which are invariant when viewed from 
the rotating reference frame. We will verify these elegant results below. With 
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Figure 9.7: Stationary Lagrange Points 


the motion of m, and mz being restricted to a circular orbit, the five possible 
locations for m for which its location appears invariant or stationary as seen by 
the rotating frame are called the Lagrange libration points L,, D2, D3, D4 and 
Ls illustrated in Figure 9.7. We can see that the “straight line” points L,, D2 
and Lz are evident from the above analysis (Figure 9.6), whereas the points L4 
and Ls are evident from the equilateral triangle solution shown in Figure 9.5. 
Their existence was thought to be of purely academic interest when Lagrange 
first presented these results. However, the Trojan asteroids were subsequently 
(1906) discovered which oscillate about the L4, D5 Sun-Jupiter Lagrange li- 
bration points. Also, the Earth-Moon Lagrange points have been studied as 
possible locations for large “space colony” space stations. Motions near D4 and 
Ls are neutrally stable; these stationary points have become popularly known 
as “Lunar Libration Points,” for the case of the Earth-Moon system. 


Please note that the labeling of the collinear libration points is not consistent 
across different text books. The notation adopted here labels the libration point 
on the far side of m, as Ly, the point between m; and m2 as L2 and the libration 
point on the far side of mz as Lz as is illustrated in Figure 9.7. This notation 
makes geometric sense since the straight line points are labeled in ascending 
order from one end of the line to the other. While there is no consensus, a 
second popular alternative is to label the Lz point as £1, D3 as D2, and Ly as 
L3. The reasoning for this choice is based on relative energy state arguments of 
bodies at these libration points. However, the L4 and Ls are uniformly labeled 
in the literature as shown here. 
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Figure 9.8: Illustration of Circular Restricted Three-Body Problem 


9.2.1 Jacobi Integral 


To develop the equations of motion of mass m near the circularly orbiting m1 
and mz, we express the inertial position vector r of m with components taking 
in a rotating reference frame F : {é,, €9,€3}. The origin of F is at the system 
center of mass as shown in Figure 9.8. Since m3 < m1, mg, from Egs. (9.56) or 
(9.61) the constant angular velocity magnitude of the m -mg system is given by 


we = ESET) (9.64) 


T2 
The angular velocity vector of the F frame relative to some inertial frame is 
w = wk. The position vector r is expressed with F frame components as 


r=, + ryfo +7263 (9.65) 


Note that while both m, and m2 perform planar, circular motions, the mass 
m is able to move both within the orbit plane and perpendicular to it. Taking 
two inertial derivatives of r while keeping in mind that F is a rotating reference 
frame, the inertial acceleration vector of r is expressed as 


P= (Fy — Wyw — rew*)E, + (Fy + Whew — ryw7)ég + Fé3 (9.66) 


The gravitational force F acting on m due to m, and mg is expressed in F 
frame components as 





(re 7 r1) AP (re = r2) 
F=-G et ee) ty (9.67) 
ma 4 m2), 
Be eae 


where the relative distances €; of m to m,; are given by 
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&=Vf(re ri)? +r2 +r? (9.68) 


Combining Eqs. (9.66) and (9.67), the equations of motion of m can be written 
as three scalar, coupled differential equations. 











Fy, — Qwry — wg +G (Srl. —ry)t+ “2 (I's — r) =0 (9.69a) 
ot & 
fy + Quty — wry + G (= a 7) ry =0 (9.69b) 
Gi & 
#46 (= es 7) pn (9.69c) 
ot 3 


Let the potential function U(rz,ry,rz) be defined as 








2 
we 59 9 Gm, Gm 
U(ra, ly; Pz =a etry) + 7 9.70 
Let the time derivative as seen by the F frame be labeled as 
F. 
“e =a) (9.71) 


Then the velocity and acceleration vectors of m as seen by F are given by 


Te Ty 
rT. a 

r= [ty r= | Fy (9.72) 
ry ry 


Using the potential function U and the local velocity and acceleration vectors, 
we are able to write the equations of motion of m in a compact vector form. 








r+ Qw xr = | a | = VU (9.73) 





By performing the vector dot product of Eq. (9.73) with r’ we find the following 
perfect differential equation: 
1d OU dU 
a Sioa / 2 / ae / Bee pss 
Sg = on > 
Integrating this equation with respect to time yields a perfect integral of the 
relative equations of motion. 


(rr! +2w xr’). =r" or (9.74) 


yar.’ =2U-—C (9.75) 


Substituting the definition of U we find Jacobi’s Integral for the circular re- 
stricted three-body problem. 
G G 
v? = w(r2 +72) 4-224 ge 
o1 &2 





a0 (9.76) 
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where the scalar constant C’ is determined through the initial conditions. Think 
of C as a negative, relative energy measure. The larger C is, the less relative 
energy the mass m has. This perfect integral of the relative equations of motion 
is used to study what trajectories of m are feasible given some initial energy 
state and as a means to verify the accuracy of a numerical integration. At 
any point in time of the motion governed by Eqs. (9.73), the Jacobi integral in 
Eq. (9.76) must be satisfied. We mention that Jacobi’s Integral is simply the 
classical energy integral (T + V = constant), expressed in rotating coordinates. 

The equations of motion in Eq. (9.69) can be written in a convenient non- 
dimensional form. To do so, we introduce the non-dimensional time variable 7 
as 


T=wt (9.77) 


Time derivatives with respect to this new time variable are denoted with the 
“o” symbol as 


fo} dx 
t= — 9.78 

dt ( ) 
The non-dimensional time derivative @ is related to the previous time derivative 
« through 


dx dxdt o 
t= = — Sw 9.79 
dt = dr dt ( ) 
Any scalar distances are non-dimensionalized by dividing them with the constant 
relative m1-my distance 112 as 
r T r r r 
1 ER ee ges (9.80) 
r12 r12 r12 r12 r12 
Note that with the new non-dimensional coordinates the masses m1 and mg are 
a unit distance apart and that therefore 


The mass quantities are non-dimensionalized by introducing the scalar param- 
eter [4 as 


m2 1 
= = 9.82 
mn m1 + me a +1 ( ) 





Since the designation of m; and mz is typically chosen such that mz < mj, we 
note that uw < 0.5. Using these non-dimensional quantities, the center of mass 
condition in Eq. (9.6) is rewritten for the current setting as 


(1 — p)a1 + pre =0 (9.83) 
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Using Eqs. (9.81) and (9.29) we are able to express the non-dimensional coor- 


dinates of m; and mz in terms of the mass ratio yu. 


t2=1-—p (9.85) 


Combining all these definitions, we now are able to rewrite the equations of 
motion of m in Eq. (9.69) into the following non-dimensional form: 











00 ° = — OU 
Pee 1S) oy ot eee (9.86a) 

PY P2 Ox 

00 ° 1l—yp a OU 
Pst (1- a Fy = 9.86b 
Pi PB Oy ee 

oo l-—yp ) OU 
ces eh Be ng =o 9.86c 
( Pi dz mene 


where the non-dimensional relative distance p; is defined as 
pi=V(e—ai)? ty? +2 (9.87) 


and the corresponding non-dimensional potential function U(x, y, z) is given by 
the expression 


1 1— 
U(a.y.2) = 5 (0? +9) + + (9.88) 


Following similar steps as were done with the dimensional equations of motion, 
the non-dimensional Jacobi integral takes on the form 


° ° 1-— 
vt = (E24 V?) = (a? +97) +2 +25 —C (9.89) 
1 ‘2 


Setting the relative velocities and accelerations in Eq. (9.86) equal to zero 
we find conditions which are satisfied by the stationary points of the circular 
restricted three-body problem. As will soon be evident, these stationary points 
are precisely the five Lagrange Libration points, L;, specialized to the case at 
had. Studying Eq. (9.86c) we see that all stationary points have z = 0 and 
therefore must lie in the rotating m1-m2 plane. Eq. (9.86b) is only equal to zero 
for the two known geometric configurations. Either y = 0 which corresponds 
to the collinear solution with all bodies aligned with the rotating é, axis, or 
P1 = p2 which corresponds to the equilateral triangle solution. To solve for the 
scalar coordinate « for the collinear L,, Lz and Lz libration points, Eq. (9.86a) 
is set equal to zero. Notice in Eq. (9.86a) the final two terms, for y = z = 0, 
simplify to 

(a — 21 (x — xq 


(= 


|x — x4|3 |x — x98 
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while one is tempted to merely cancel in these fractions, care must be taken to 
obtain the correct signs because obviously 


(x — 24) = —|x — 2; | if (vw — 24) <0 
(a —2;) = +x —a;| if (vw —2;) >0 


Using the libration point labeling shown in Figure 9.7, for the L1 point it is 
clear that « — 21 <0 and x — x2 <0. Using these facts and Eqs. (9.84), (9.85) 
and (9.87) we find from Eq. (9.86a) an explicit condition for the L; position 
coordinate in terms of the mass ratio p. 
Lupe LM 
Ty: x + ——~ + ——, = 0 9.90 
Gra? ttm ey 
This equation in essence replaces Lagrange’s quintic equation for the circular 
restricted cases where m3 < mj1,m2. Examining the L2 Lagrange libration 
point we find that x — 2, > 0 and x — 22 < 0. This leads to the necessary 
condition 


lp LM 
To: — — + — ~~ = 0 9.91 
2 Aiea (Te ee 


For L3 we find that x — 2, > 0 and x — x2 > 0 and therefore 


l-yp LM 

D3: x “tae Guten? =0 (9.92) 
Egs. (9.90) through (9.92) provide three simplified, explicit relationships to solve 
for the three collinear Lagrange Libration point x coordinates. The advantage 
of these compared to solving the Lagrange quintic equation is that there is no 
need to reorder the indices to obtain the three possible solutions. By making 
use of the known sign of the x — x; terms for each libration point we are able to 
find these simplified expressions. 


Example 9.5: For the Earth-Moon system assuming the approximation that 
their paths both describe circular orbits about the common center of mass, 
we can make use of the circular restricted three-body problem to compute 
the straight line libration points. For this system the mass ratio ju is given by 


1 
Pe S134+1 
Solving Eqs. (9.90) through (9.92) for the non-dimensional x coordinates we 


find 
I1: «x =—1.00506 Le, « = 0.836915 [3: «x = 1.15568 


Remember that the radial Earth-Moon distance is equal to 1 with these non- 
dimensional coordinates. As expected, the L2 point is between the Earth- 
Moon system, the L; is on the “back-side” of Earth and L3 is on the “back- 
side” of the Moon. 
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9.2.2 Zero Relative Velocity Surfaces 


Jacobi’s integral in Eq. (9.76) or (9.89) provides a very interesting exact integral 
of the relative equations of motion of m. The accuracy of a numerical simula- 
tion can be verified by checking that the constant C indeed remains invariant 
during a simulation. Another popular use of the Jacobi integral is to establish 
regions around m,; and m2 within which m may travel given its initial states. 
For unpowered flight, the initial position and velocity determine the resulting 
trajectory. Through the Jacobi integral, the initial states also determine the 
value of the constant C’. Recall that C' provides a negative relative energy mea- 
sure of the body m. Extreme points on a trajectory are encountered whenever 
the velocity magnitude v goes to zero. Therefore, setting v = 0 in the Jacobi 
integral for a given energy constant C' provides an algebraic expression of all 
such feasible (a, y, z) “apogee-like” locations. 


{= 
(22 +y2) +2" +24 -¢ (9.93) 
Pl pP2 


The surfaces described by Eq. (9.93) determine the geometric extremes possible 




















Figure 9.9: Zero Relative Velocity Surface Contours of the Earth-Moon 
System in the z — y Plane 


for a given relative energy state. For example, studying these surfaces allows us 
to quickly determine if it is possible for a body to travel from Earth to Moon or 
beyond. Note that when a mass m is located on this surface, this only implies 
that its velocity relative to the rotating F frame is zero, not that its inertial 
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velocity is zero. However, studying the motion of m as seen by the rotating 
reference frame is very convenient when exploring possible trajectories near two 
orbiting celestial bodies. Selected zero relative velocity surface contours for 
the Earth (mass m,) and Moon (mass m2) system are shown in Figure 9.9. 
The darker the coloring, the more energy (relative to the rotating frame) is 
required to enter these areas. When an object has a low relative energy state 
(i.e. the constant C is large), it may be in one of three areas. The areas are 
the immediate vicinity around either Earth or Moon, or far removed from the 
Earth-Moon system. Studying Eq. (9.93) it is evident that if (2,y) and C are 
large, then p; and po are also large and the zero velocity surface expression is 
dominated by the quadratic terms in Eq. (9.93) and can be approximated as 


g+y=C (9.94) 


This implies that away from the circularly orbiting two body system, the zero 
velocity surface becomes a circular cylinder with the symmetry axis aligned 
with the rotation axis é3. In the planar cross section shown in Figure 9.9, this 
is visible as circular constant energy contours. If the body m is close to either 
my or mz while C is large, then p, or p2 respectively will become small and the 
dominance of either the second or third term in Eq. (9.93) will result in the zero 
velocity surface being approximated either by 


A(1 — ps)? 
pha (e—ay)r + ye 22 =O (9.95) 
for p; being small or by 
4 2 
pp = (w@—a) ty t2= = (9.96) 


for p2 being small. For this limiting case the zero relative velocity surfaces 
shapes converge to perfect spheres about either the locations of either mj, or 
mg. Figure 9.9 illustrates this behavior through the white circular contours 
around both Earth and Moon. As the energy of m increases, more volume 
becomes accessible and the closed regions near the Earth or Moon ultimately 
open such that motion is not confined to remain near either massive body; at 
these energy stages “interchange” orbits are feasible. The last two excluded 
regions correspond to the minimum C’ regions around the D4 and Ls Lagrange 
libration points. Figure 9.10 shows individual zero velocity surface contours in 
the «—y plane for various critical energy state. Regions that cannot be reached 
by m with the current energy state are grayed out with the same darkness 
as they have in Figure 9.9. The first critical state is where m has just enough 
energy to reach the Lz point between m1 and mz. Increasing the energy state of 
m infinitesimally beyond this state opens up a corridor between the two orbiting 
bodies, making it theoretically possible for an object to pass from one body to 
another. However, it is still impossible for an object near m, or mz to leave 
the two body system. The next critical energy state is where the zero velocity 
surface reaches the L3 point. Any additional energy now makes it possible for 
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Figure 9.10: Critical Zero Relative Velocity Surface Contours of the 
Earth-Moon System Touching the Lagrange Stationary 
Points 


m to theoretically escape the two-body system. The next critical stage is where 
the zero velocity surface just touches the L; point. The last forbidden regions 
to vanish are the banana shaped ones around the La and Ls libration points. 
Therefore, from an energy point of view, some people opt to label Lz as the 
first libration point, since it requires the least amount of energy to reach. The 
remaining libration points are then labeled according to the ascending energy 
states. 

Three-dimensional cross sections of these critical zero relative velocity sur- 
faces of the Earth-Moon system are shown in Figures 9.11 through 9.14. Both 
x—y and x — z cross sectional cuts are shown. Due to symmetry, the missing 
halves of these surfaces are mirror images of the displayed halves. Figure 9.11 
shows the critical surface which touches Lz. A steep cylindrical wall separates 
possible trajectories outside the two-body system and within them. At this 
critical energy state, the oval surface shape about the Moon just touches the 
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(i) Cross-Section Cut at z = 0 (ii) Cross-Section Cut at y = 0 


Figure 9.11: Zero Relative Velocity Surface Touching L2 





(i) Cross-Section Cut at z = 0 (ii) Cross-Section Cut at y = 0 


Figure 9.12: Zero Relative Velocity Surface Touching L3 


350 RESTRICTED THREE-BODY PROBLEM CHAPTER 9 





(i) Cross-Section Cut at z = 0 (ii) Cross-Section Cut at y = 0 


Figure 9.13: Zero Relative Velocity Surface Touching 11 





(i) Cross-Section Cut at z = 0 (ii) Cross-Section Cut at y = 0 


Figure 9.14: Zero Relative Velocity Surface in the Neighborhood of La 
and Ls 
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corresponding surface about Earth. Further, due to the centrifugal effect of 
moving in an orbiting two body system, the possible motions of body m are 
clearly more restricted along the two-body rotation axis than within the rota- 
tion plane (z,y). This is manifested through the flattening effect of the oval 
surface shapes about Earth and Moon. As is shown in Eqs. (9.95) and (9.96), 
for lower energy states (larger C’) about Earth and Moon these surfaces will 
approach spherical shapes. 

As the energy state of m increases, a corridor for feasible motion opens 
between Earth and Moon as is shown in Figure 9.12. Note however that m 
cannot escape the Earth-Moon system yet until the “bubble” around the Moon 
just touches the outside cylindrical surface. Increasing the relative energy state 
of m even more now opens up a corridor through to the open region on the 
far side of the Moon. Note that m does not yet have enough energy to escape 
Earth’s gravitational influence without the assistance of the moon at this point. 
However, since the moon acts here as a gravitational boost, it is possible for the 
body m to escape Earth’s influence. 

Adding more energy, the body m can escape the Earth-Moon system through 
multiple directions. Only the regions around the L4 and Ls Lagrange stationary 
points are still unreachable with zero relative velocity. The vertical cylinder is 
now almost completely separated into a upper and lower sections. The two 
surfaces only connect around L4 and Ls5. Note that the energy increase between 
a surface touching the Z4 and Ls points and a surface touching the Lj point is 
relatively small. The energy increments between each surface are not uniform 
in Figures 9.11 through 9.14. Rather, particular energy states were chosen to 
illustrate interesting behaviors. Further, note that these surfaces only show the 
limits to all feasible trajectories. Given only these surfaces, no statements can 
be made about the various trajectories themselves however. 


Example 9.6: Two Earth-Moon trajectories are illustrated as seen by the 
rotating reference frame F. The first example illustrates an Apollo type 
mission discussed in Reference 2. At periselenium (point of closest approach 
to the moon), the mass m has the non-dimensional coordinates 


(x,y) = (0.992761, 0) 


which correspond to a miss distance from the Moon's surface of about 150 
km. The non-dimensional relative velocity magnitude v at periselenium is 2.47 
or about 2.531 km/s. The corresponding Earth-Moon trajectory is shown as 
seen in the rotating reference frame in Figure 9.15. 


The famous hour-glass trajectory is thickened out in this figure since it drawn 
in the rotating reference frame. The critical zero-velocity surface which 
touches the L3 Lagrange Libration point is superimposed in this illustration. 
Clearly this trajectory penetrates this surface. Thus the body m has enough 
energy to escape the Earth-Moon system given the proper initial position and 
velocity direction. This illustrates again that the zero velocity surface can 
only predict which regions a body will not be able to enter with a given en- 
ergy level. They do no predict what paths a body will take. More specifically, 
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Figure 9.15: Apollo Type Earth-Moon Trajectory as seen by a Rotating 
Reference Frame 


restricting energy below the value corresponding to a given closed zero ve- 
locity surface, we are guarantee the body cannot exit that closed region; we 
cannot guarantee a higher energy will escape that surface during any finite 
time interval. 


Q 
Final Moon Position \ 





Initial Earth Position 


<—________ 





Final Earth Position 


Initial Moon Position / 
ww 


Figure 9.16: Apollo Type Earth-Moon Trajectory as seen by an Inertial 
Reference Frame 


The same trajectory is shown as seen by a non-rotating, inertial frame in Fig- 
ure 9.16. This view illustrates well how the traveling Moon sharply bends the 
spacecraft trajectory back towards Earth. Also, it is evident that the Moon 
travels a large distance during this trajectory, thus constantly changing the 
direction of its gravitational pull. While this figure provides a better illustra- 
tion of the actual flight path shape, note that it is more difficult to assess 
if the spacecraft will impact with either Earth or Moon. Both bodies have 
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time varying positions and it isn’t clear that the spacecraft trajectory does 
not intersect with either the Earth’s or the Moon’s surface. This analysis is 
best performed in Earth- or Moon-centered coordinate systems which trans- 
late with the Earth or Moon and study only the portion of the trajectory near 
closest approach. 

As a comparison, another Earth-Moon trajectory is shown in Figure 9.17. At 
periselenium, the body m has a Moon surface miss distance of 884 km and 
the critical L3 velocity of 1.872 km/s. 








Unreachable 
Region 





Zero-Velocity Contour 
which touches L3 








Figure 9.17: Subcritical Earth-Moon Trajectory as seen by Rotating 
Reference Frame 


This trajectory has a close approach with the critical D3 surface, meaning 
that at that point the relative velocity of m as seen by the rotating frame 
is close to zero. Even though the energy state of this trajectory is less than 
the previous one, it is clearly less desirable for mission planning. The closest 
approach to the Moon and especially to Earth are much larger. This would 
require additional maneuvers out of Earth and Moon parking orbits to reach 
the this trajectory. A quick numerical study shows that it is impossible to 
reach the Moon from a tight Earth parking orbit with a sub-critical D3 energy 
state. 


9.2.3 Lagrange Libration Point Stability 


Of particular interest is whether motions near the Lagrange stationary points 
L,, are stable solutions of the relative equations of motion. The question is: 
If a body starts out at rest near a Lagrange libration point, will it remain in 
the vicinity or will it wander off over time? If the motions are stable, one 
could expect that it would take less fuel for a spacecraft to maintain its relative 
position there. Studying the zero velocity contours in Figures 9.9 and 9.10, 
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initial guesses can be made as to the stability of the five libration points. Due 
to the “saddle-point” nature of the zero-velocity contours touching D1, D2 and 
L3, we can expect the first three Libration points to be unstable. Only the Ly 
and Ls Libration points of the equilateral triangle solution may by neutrally 
stable. To study the stability of a particular L; point, we linearize the relative 
equations of motion about LD; and check whether any eigenvalues of the linearized 
plant matrix have positive, real components. To simplify the development, the 
non-dimensional equations of motion in Eq. (9.86) are written in vector form as 
Lima 


(r— 11) — al — 12) = f(r) (9.97) 


r +a] 7 +[a?r = — 
PY 





where r = (2,y,z)7, r1 = (—p,0,0)7, ro = (1 — p, 0,0)? and 2 = (1,0,0)7 
is a non-dimensionalized angular velocity vector. Let the departure motion ér 
about a point ro be defined as 


or=r—T9 (9.98) 
Then the linearized departure motion about ro is given by 


br +[Q]ér +[(QP5r = of or (9.99) 


To evaluate the partial derivative of f with respect to r, the following partial 
derivative is useful: 





(9.100) 


Linearizing the force vector f about ro then yields 


_ of 1l—p 





F= ao. = R (3(r — r1)(r — 11)" — pi [sxs]) 
TO 
ae a (3(r — r2)(r — 72)" — p3[Isx3]) (9-101) 
2 
By defining the state vector X as 
X = (dr, or)? (9.102) 


we write the equations of motion in Eq. (9.99) in first order state space form 


oO 


X=([M(ro)|X (9.103) 


with the plant matrix [/] defined as 


[M(r)] = Fe ap | (9.104) 
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By evaluating [M] at the five Lagrange libration points and checking the corre- 
sponding eigenvalues for positive real parts, we are able to make some statements 
concerning the local stability of motion near these points. 

Let us first investigate the stability of the collinear £1, D2 and L3 Lagrange 
libration points. Let ro = (a0,0,0)" be a position vector of one of these station- 
ary points. Since for each of these yo = zo = 0, the terms p; and p2 evaluated 
at To are 


pil(ro) =|zo+H| — p2(ro) = |tvo —1 + pl (9.105) 


Evaluating the matrix [F] at ro we then find 


2E 0 0 
[F(ro] =] 0 -E 0 (9.106) 
= Oh 8 


with the constant positive scalar & defined as 
sol EE ln alt 
pi(To) — p3(r0) 


Substituting Eq. (9.106) into Eq. (9.104) and computing the six eigenvalues of 
[MM], we find 


E(ro) (9.107) 


E-24+VJ/9E?—-—8E 
Ni2,3,4 wi 3 (9.108) 





M6 =—1 (9.109) 


The collinear stationary points are unstable if Eq. (9.108) is positive, since this 
results in one of the eigenvalues having a positive real root. For Eq. (9.108) to 
be positive, then 


QE+1)(E-1)>0 (9.110) 
must be true. Since F > 0, this condition can simplified to 
E>1 (9.111) 


It has been shown that EF > 1 holds for all possible values of ~ between 0 and 
0.5, for all collinear stationary points.1 Some of the first four eigenvalues in 
Eq. (9.108) have positive real parts. Therefore all collinear Lagrange libration 
points must be considered unstable. 

To study the stability of the L4 and Ls Lagrange libration points, we note 
that for the non-dimensional equilateral triangle the relative distances p; are 


The position vector ro of L4 and Ls is given by 
& 
a (9.113) 


LE NIR 





Tro = 
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where the negative sign corresponds to the Ls case. Substituting Eqs. (9.112) 
and (9.113) into Eq. (9.101), the [Ff] matrix is computed for these Lagrange 
points as 














hes -1 +38V3 0 -1 73V3 0 
[F(ro)]=—* |43v3 5 0 | +S ]e3v8 5 0] (9.114) 
0 0 —4 0 0 —-4 


Using Eq. (9.114) in Eq. (9.104), we find that the eigenvalues of [M/(ro)] are the 
same for both D4 and Ls. 





2 — 
At2,3,4 = 5 
Ne =—l (9.116) 
For the eigenvalues in Eq. (9.115) to be purely imaginary, it is necessary that 
LS 9700 =p) So (9.117) 


A quick numerical check shows that the upper bound is always satisfied. Since 
0 < p < 0.5, the maximum permissible y such that the right inequality of 
Eq. (9.117) is still satisfied is 


1 1 [3 
Biase ey | es O88 5908 9.118 
_ 2 6V3 (9.118) 


Since for the Earth-Moon system p * 0.01230, motions near these D4 and Ls 
points are neutrally stable in their close vicinity. Using the definition of ju, the 
condition in Eq. (9.117) can also be written as? 


—— sf > 25 (9.119) 


Defining a to be the direct ratio of m, and mz, the minimum ratio necessary 
for Eq. (9.119) to be true is 


~ 24.9599 (9.120) 


25 + 3V69 
aQnin =, 
2 
This implies for motion near the corresponding D4 and Ls Lagrange libration 
points to be neutrally stable, the larger mass m, must be at least roughly 25 

times larger than mg. 

Nature has provided us with proof that the equilateral triangle configuration 
of the circular restricted three-body problem is indeed neutrally stable. In the 
Sun-Jupiter system (4 * 0.001) a group of asteroids called the Trojans have 
been found in 1906 at the corresponding D4 and L; libration points; a group of 
five were detected at D4 and a group of ten at Ls. Since then, over 1000 Trojan 
asteroids have been found at LD, and Ls, providing nature’s very significant 
empirical statement regarding the stability of motion near L4 and Ls. All of 
these asteroids oscillate in an apparently neutrally stable manner in the vicinity 
of these stationary points. 
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Example 9.7: This example illustrates the neutral stability of the Earth- 
Moon L, Lagrange libration points. The initial position vector r(to) touches 
the zero relative velocity surface with C = 2.9884. 


r(to) = (0.4925060, .85, 0)” 


The resulting motion is illustrated to scale with Earth and Moon in Fig- 
ure 9.18. 
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Figure 9.18: Unpowered Motion in the Vicinity of the Earth-Moon L4 
Lagrange Libration Point 


While the body m does wander away from the immediate vicinity of La, 
it does “librate” in the neighborhood of 4. Note that by starting out with 
zero relative velocity (i.e. touching the shown zero-velocity surface), the body 
does periodically return very near this surface again. While it can theoretically 
touch this zero velocity surface, it is not guaranteed to do so. Note that the 
illustrated zero velocity surface is actually a rather large neighborhood about 
L4. lf a tighter surface is chosen (i.e. r(to) closer to La), then the resulting 
oscillations about L4 would occupy a much smaller region near La. We note 
that rigorous nonlinear guarantees that the oscillations stay in a bounded 
region near D4 have not been established. However, numerical studies and the 
Trojan asteroids indicate neutral stability for a large family of initial conditions 
near La and Ls. 


9.3. Periodic Stationary Orbits 


Clearly the stationary points of the circular restricted three-body problem are of 
great practical interest. After their discovery by Lagrange, much effort has been 
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spent on trying to find periodic stationary orbits of this three-body problem. 
These orbits form closed three-dimensional curves and remain fixed as seen by 
the rotating reference frame F. Thousands such orbits have been found for 
various values of 44, not all of them are necessarily of practical value. It turns 
out that these stationary periodic orbits can be grouped into families of orbits 
which help to explain the more general classes of orbits for this restricted three- 
body problem. An excellent treatise on this topic is Victor Szebehely’s book 
entitled Theory of Orbits, The Restricted Problem of Three Bodies.* However, 
presenting these very intriguing orbits is beyond the scope of this book. 

To appreciate the flavor of these nonlinear periodic motions, an interesting 
stationary periodic lunar orbit is shown in Figure 9.19. This type of orbit 
is commonly referred to as a “halo” orbit for obvious reasons. As seen from 
Earth, this orbit describes a ring or “halo” about the Moon. Where previously 
we were typically illustrating planar trajectories between the Earth and Moon, 
this lunar orbit illustrates a three-dimensional trajectory. As seen from Earth 
(y— z plane view in Figure 9.19(ii)) the closed flight path has a shape similar to 
an ellipse with the moon in what would be the focal point. In the side view in 
Figure 9.19(iii) it is apparent that the space curve is essentially located on the 
far side of the moon between the moon and L3. Also, the “orbit plane” is not flat 
but curved away from the Earth and Moon toward L3. By always being in line 
of sight with Earth and hovering behind the moon, this lunar halo trajectory 
would be a great parking orbit for a lunar communications satellite. Currently, if 
any spacecraft travels to the far side of the Moon all communications cease. For 
future missions to the moon and establishing permanent bases and installations 
there, having a continuous communication capability between Earth and Moon 
would be essential. In particular, the far side of the moon is a superb location 
to place a deep-space radio telescope. However, since the Moon doesn’t rotate 
as seen by Earth, communicating with this installation would be impossible 
without a communications satellite in lunar orbit. 

For a periodic orbit to be practically useful, its stability must also be in- 
vestigated. Since the two massive bodies never precisely have circular orbits 
about their system mass center, and often there are other bodies such as plan- 
ets or the sun which exert a small influence on the three-body system, it must 
be assumed that small external influences are always present. Also, we observe 
that launch errors result in imperfect initial conditions. Therefore placing a 
spacecraft in a near-periodic orbit or near a libration point, a periodic orbit 
correction must be expected to maintain the desired trajectory. The frequency 
of these corrections would depend on stability of the stationary orbit. Roy+ 
outlines a systematic process for searching out periodic orbits in the three-body 
problem, and Breakwell* provides an approach for studying orbital stability. 


9.4 The Disturbing Function 


When one celestial body dominates the motion of other bodies, it is often conve- 
nient to write the position vectors of these other bodies relative to the dominant 
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Figure 9.19: Stationary Lunar Halo Orbit 


body. For example, in our solar system the sun is the dominant influence on 
the motion of the planets. The mutual attraction of the various planets only 
has a very minor effect on their flight paths. Another example is the lunar 
motion about Earth. The lunar orbit is mainly determined through the grav- 
itational attraction of the Earth, while the sun’s gravitational attraction only 
has a secondary effect. Writing the equations of motion relative to a dominant 
celestial body, we are able so what secondary effect the gravitational attraction 
the remaining bodies will have. 
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In this section, the motion of each body is not restricted as was the case 
with the previous cases. Also, we now consider a more general problem where 
n bodies are present. However, we do assume that one of the bodies plays a 
dominant role on the motion of a set of bodies. Without loss of generality, let 
us take m, to be the dominant body. From Eq. (9.3), its equations of motion 
are given by 


=O im, 
= Gy = me (9.121) 
j=2 0 


where r; are inertial position vectors of each body and the relative position 
vectors r;; are defined as 


Pig =F -TL FRM - V1 (9.122) 


The equations of motion of each remaining body is given by 


ay ae ” ig a os 
nR=GS., aij  fori=2,...,n (9.123) 
j=l jAi 


Subtracting Eq. (9.123) from (9.121), the relative equations of motion of the 
n — 1 bodies relative to m; are found to be 


n 


n 
we = os my m4 mj; mM; 
TyH=7T- M1 = G Ti + ) po = ) eo = asi (9.124) 


re 3 : : 
ue j=2,j541 4 j=2,j541 
Using Eq. (9.122) and r;; = —r;; these relative equations of motion are rewritten 
as 
et G m + mM; a T15—7T1; T1; 
Tut eK ~ Dn, =G bs 3 “2 3 = — (9.125) 
Ti jad, ei "iy "3 


If only two bodies are present, note that the standard Keplerian two-body equa- 
tions of motion are retrieved. The gravitational effect of bodies other than m1 
and m,; appear a disturbance terms in this formulation. 


Example 9.8: Consider the Earth-Moon-Sun three-body system with Earth 
being mass mg, the moon mq being the mass moving in Earth’s proxim- 
ity, and the sun mo being the external influence of this two-body system. 
Eq. (9.125) in this case reduces to 


‘ G(me + mq) _ rEO-TEC TO 
Fo¢ + ——3_— rat = Gmo | —, —— - B 
TOC "© "BO 


At first glance it may seem like the sun’s gravitation influence would be very 
large in these relative equations of motion since m@,mc < mo. However, 
due to the large relative distance involved between the sun and the Earth 
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and Moon we can make the approximation r@@ © r@o. Therefore, the lunar 
relative equation of motion are approximated as 





BS G(me + m« THC 
Pec t+ GOTO 5 = —GMoz 
eq TSO 


For this Earth-Moon-Sun three-body system, the gravitational acceleration 
magnitudes of the Earth-Moon attraction and the solar attraction are related 


through 
MOPS 9 4 ggg5g@O MO 
"OO "OC 


Therefore the solar gravitational attraction on the moon is over two orders of 
magnitude smaller than the relative Keplerian Earth-Moon motion attraction. 


As is the case in Keplerian motion, it is possible to write the acceleration 
expression as the gradient of a potential function. The gravitational potential 
function V;, which leads to a Keplerian m; — m; motion, is given by 

G +m; 
eae (9.126) 
Ti 
Note that Eq. (9.126) is identical to the potential function defined in Eq. (8.47). 
Computing the gradient of V; with respect to the position vector r1; we find 


G 4 
Vacv= EO (9.127) 


Thi 


Eq. (9.127) provides the acceleration due to the gravitational attraction between 
my, and m;. To compute the disturbance acceleration due the the remaining 
(n — 2) bodies, we define the scalar disturbance function R,; to be 


R= > m; (2 2 | (9.128) 
ose aap lig Ty 
j=2,j5#% q 


The gradient of the disturbance function R; produces the acceleration due the 
gravitational attraction with the remaining bodies. 


. T1y7- T1i Ty 
Vighe=@ SS [Soot = = | (9.129) 
j=2,5#% g 1 


Using Eqs. (9.127) and (9.129), the equations of motion of m, relative to m1 
are written compactly as 


Fig = —Vri, (Vi — Ri) (9.130) 
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Example 9.9: The gravitational solar disturbance acceleration the relative 
motion of the Moon experiences in orbit about the Earth was very small in 
Example 9.8 because of the large distances involved between the sun and the 
Earth-Moon system. In this example, we treat the sun (m@) as the dominant 
mass influencing the motion of the Earth (m@). The gravitational effect of 
the moon (mq) on the relative motion of Earth about the sun is now treated 
as a perturbation. The relative equations of motion of the Earth about the 
sun are written as 


. G(mo + me 
ig ne) 


(“= — TOS 4) 
ToO@ = Gm | ———— - = 
TOS 


3 3 
Tl@ TOC 


The magnitude of the perturbative acceleration due to the moon has the 
upper bound 


Gme (“= =TO@ _ “) A. ( 2 of ) _, 2Gm« 
3 3 = 2 a | YS 
"™@ "OC "oO TO "lO 





where the approximation is done since r@@ < rec. Note that this upper 
bound on lunar influence is computed when the Moon lies perfectly between 
the Sun and Earth or on the far side of the Earth. Therefore the acceleration 
magnitudes of the two-body solution and the lunar gravitational attraction 
relate through 


oe ~ o.o112mo+me) 


TO TOO 





During periods of strongest influence, the gravitational lunar attraction of the 
Earth only affects its orbit about the sun by about 1 percent. 


Problems 


9.1 


9.2 


Compute where the Moon would have to be located relative to the Earth for it 
to continuously be in a “full Moon” state as seen from Earth, and ignoring the 
Earth's shadow. Treat the Sun-Earth-Moon as a three-body system. 


Assume that the bodies m1 = 2m2 = 3mz3 are in elliptic orbits about their 
system center of mass where m1 has the mass of Earth. 


a) Choose a coordinate system and compute the location of each mass if they 
are either in a triangular or collinear configuration. 


b) Assuming that the initial velocity magnitude of each body is given by 
Eq. (9.56), numerically compute the resulting orbits if the initial velocity 
vectors form a 30° angle with the respective radial position vectors. 


c) Repeat the previous task with the initial velocity vectors forming 90° angles 
with the corresponding radial position vectors. 
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9.3 


9.4 


9.5 


9.6 


9.7 


9.8 


9.9 


9.10 


Set up the three masses m1 = 2mz2 = 3mz in an equilateral triangle configuration 
with a zero angular velocity about the system mass center. 


a) Verify that the net sum force F; acting on each body m; indeed points 
from each mass directly to the system mass center. 


b) Verify that the force magnitude F; of each mass is equal to GM, /r? where 
the equivalent masses M; are defined in Eqs. (9.38) through (9.40). 


For the Sun-Earth two-body system, compute the corresponding libration points 
in both dimensional and non-dimensional units. 


Derive the non-dimensional equations of motion in Eq. (9.86) from Eq. (9.69). 
Show all algebra. 


Treating the Sun-Earth-spacecraft system as a circular restricted three-body prob- 
lem, what is the minimum relative energy v? necessary that a spacecraft must 
have to travel in theory from Earth to the sun? 


For the Sun-Earth system, compute the corresponding zero-velocity surfaces that 
touch the L,, Lz and Lz points. 


@& Assume the Sun-Jupiter system two-body system is describing circular orbits 


about their center of mass. The radial distance between Jupiter and the sun is 
778 - 10° km. The mass of Jupiter is my =1.9- 10°” kg and the mass of the 
sun is m@ = 1.989 - 107° kg. 


a) Compute the five stationary Lagrange points as seen by the rotating coor- 
dinate system. 


b) Investigate the stability of each point placing an object in the neighborhood 
of each libration point and numerically solving for the resulting motion. 
Make conclusions on the “level” of stability or instability. 


Consider the Keplerian two-body problem where the inertially fixed mass m1 is 
a very massive body as compared to the second mass m. The gravitational 
potential of m is assumed to be too small to affect the motion of m1. 


a) Write the energy (or vis-viva) equation in a form analogous to Eq. (9.76) 
or (9.89). 


b) Investigate the zero-velocity surfaces for this two-body problem. What 
type of orbit must m have about mj for it to reach this surface? 


Consider the Earth-Moon system. Compute the three locations where the cen- 
trifugal acceleration is canceled exactly by the combined gravitational attraction 
of Earth and Moon. Verify that these three locations are indeed the three collinear 
Lagrange stationary solutions of the circular restricted three-body problem. 
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CHAPTER TEN 


Gravitational Potential 
Field Models 





Keplerian motion is equivalent to the gravitational two body problem; i.e. the 
situation where the motion of a particle of unit mass is determined by a point 
mass gravitational field Vo = —Gm/r generated by a second body (a point mass 
or spherically symmetric finite body) of mass m. The scalar parameter r is the 
relative distance between the two center of masses and G is the universal gravity 
constant. This type of gravity field is also sometimes referred to as an inverse 
square gravity field, since the gravitational force drops of with the square of the 
relative distance. The study of the motion induced by such simple gravity fields 
has led to the well known analytical solution of the two body problem. The 
essential features of this solution were discovered empirically and geometrically 
by Kepler who published these results in 1609. Newton subsequently derived an 
analytical solution based upon calculus differential equations, and the universal 
law of gravitation. 

However, modern celestial mechanics applications often require orbit pre- 
cision which exceeds that obtained by the simplified Keplerian motion. For 
example, satellites in near Earth orbit are subject to a variety of gravitational 
attractions besides the point mass attraction of Earth. Since the Earth’s shape 
is not perfectly spherical, but rather more nearly that of an oblate ellipsoid, 
there is more mass along the equator than there is along the polar regions. This 
flattening out of the Earth is the cause of various orbit perturbations and pre- 
cessions. However, orbit precession does not necessarily have to be a mission 
design nuisance, it can act in our favor. It is possible to set up a satellite orbit 
inclination angle such that the orbit precesses at the same rate as the Earth is 
traveling about the Sun. These orbits are called Sun-synchronous orbits and 
can, for example, allow the spacecraft to remain in continuous sunlight. Besides 
the non-spherical shape of Earth, its non-homogeneous mass distribution fur- 
ther leads to small irregular variations in the Earth’s gravity field. This chapter 
develops methods to express the gravity potential field about an arbitrary finite 
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body. A typical starting point is to write the actual gravity potential V as 
V(r) = Vo(r) — R(r) (10.1) 


where Vo(r) is the reference potential, typically the dominant point mass po- 
tential and R(r) is the potential function due to all other variations from the 
spherical homogenous idealization of the Earth’s mass distribution. More gen- 
erally, R(r) could represent all conservative force potentials other then Vo(r). 
This could include, for example, attractions by other solar system bodies such 
as the Sun, Moon, Jupiter, and so on, because it is also obviously possible for 
the ideal Keplerian gravity field to be significantly perturbed by the presence of 
additional celestial bodies. Which perturbations must be included depends on 
many things, but most strongly upon: (i) where is the spacecraft relative to the 
other solar bodies, (ii) what level of precision is sought. For example, satellites 
in higher Earth orbit are obviously perturbed by the gravitational attraction 
of the Moon and the Sun. The motion of Jupiter’s moons is affected by their 
mutual presence. Beyond the two-body theory, unfortunately there exists no 
general analytical theory to describe the orbits of a multi-body system. Some 
special three-body solutions were discussed in the previous chapter. However, 
clearly one can frequently treat the Moon or the Earth as a single body and 
ignore the presence of other planets and moons in the solar system if one is 
close enough to a particular body. The last section of this chapter outlines a 
method to compute the gravitational sphere of influence of a celestial body. For 
example, this theory provides measures of the regions in which satellite motion 
is dominated by Earth’s gravity field, and alternatively, the regions in which 
motion is dominated by either the gravity field of the Moon or the Sun. 


10.1 Gravitational Potential of Finite Bodies 


Assume that a celestial body has an arbitrary shape and composition as shown 
in Figure 10.1. The coordinate system C : {t¢,?,, 7c} is fixed with the body. Note 
that its coordinate origin is not necessarily fixed to the center of mass at this 
point. We would like to determine the gravitational potential that a one would 
experience at an arbitrary point P outside the body. At its worst case, the true 
body may be of arbitrary shape such as is the case when attempting to orbit 
about a comet or asteroid. However, we will see that the mathematics greatly 
simplifies when we can approximate the body as being axially symmetric. 

Any finite body can be considered to be the sum of an infinite number of 
infinitesimal mass components dm. Since each dm is infinitesimal, it produces 
an elementary point differential mass gravitational field. The gravitation field 
dV that is experienced at point P due to the differential mass dm is then given 
by 


G dm 


Ss 


dV = 





(10.2) 
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Figure 10.1: Gravity Potential of an Arbitrary Body using Cartesian 
Coordinates 


where G is the universal gravitational constant and s is the magnitude of the 
relative position vector between dm and P. Note that this gravity potential 
definition yields a gravity potential per unit mass. Thus, taking the gradient 
of V, as is done in Eq. (2.5), will yield the acceleration a body will experience 
at point P. To obtain the gravitational potential energy expression between 
the mass dm and a mass at point P as discussed in chapter 2, we would use 
Eq. (2.6). Using the gradient of the gravitational potential function shown in 
Eq. (10.2) as the inertial acceleration implicitly assumes that the gravitation 
field of body B is not affected by the small bodies moving in its vicinity. While 
using the relative position vector s to express the infinitesimal potential field 
of dm, it is necessary to integrate this result to yield the total gravitation field. 
The integration is facilitated if we express all vectors in the body fixed frame C. 
Thus the relative distance s is written as 


s=T-—p (10.3) 


Note s? = s-s = r?+p?—2p-r, leading to the law of cosines; the scalar relative 
distance s is then expressed as 


s=r (1 4 ay ~2 (5) c057) - (10.4) 


Substituting Eq. (10.4) into Eq. (10.2), the gravitational potential of dm is 
expressed as 


G dm 
r (1 ife( BB) cos) - 


Before we attempt to integrate the gravitational potential field of the entire 
body, we digress to the introduce a convenient definition of the Legendre poly- 
nomials P;,(v). Expanding (1 — 2va + x?)~!/? using the binomial theorem, and 


dV (r, p, y,dm) == (10.5) 
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k 


collecting on x”, we are led to 


(1 — Qua + a?)-V/? = =YAw (10.6) 


Note that the infinite series will only converge if |x| < 1. Legendre polynomials 
are a classical set of orthogonal polynomials which can be computed recursively. 
From Eq. (10.6), it is easy to verify that the first four Legendre polynomials are 
given by 


Po(v) = (10.7a) 
P,(v) = (10.7b) 
P2(v) = a —1)/2 (10.7c) 
P3(v) = (5v3 — 3v)/2 (10.7d) 


The higher order Legendre polynomials can be obtained using the recursive 
formula 





2n+1 
V 


Pr+i(v) = n+1 


P,,(v) — _4(v) (10.8) 


n 
ay 
n+1 


These polynomials also satisfy the convenient zero mean condition 


7 P,(v)dv = 0 (10.9) 


-1 


as well as the orthogonality condition 


iL P;(v)Px(v)dv = 0 for j #k (10.10) 


-1 


Using the Legendre polynomial identity in Eq. (10.6), the gravitational po- 
tential of dm is rewritten as the infinite sum 
Gdm < k 
dV (r, p,y,dm) = -2— (5) P,(cos7) (10.11) 
r 


k=0 


Note that we are assuming here that p/r is less than one that the point of 
interest r is outside of the body 8. Finally, integrating over the entire body, 
we eliminate dependence on p, y and dm and obtain a general solution of the 
gravitation potential field of an arbitrary body B. 


Vis Gm 





Be (cosy)dm (10.12) 





Note that this solution is valid for a body of arbitrary shape and arbitrary 
density variation. The only restriction applied so far is that the coordinate 
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system C is fixed in the body. An immediate benefit of using the orthogonal 
Legendre polynomials in this infinite series expression is that they allow us to 
break down the gravity field components as a series of successively less relevant 
(typically) contributions. Since p/r < 1, the contribution of the k-th element is 
multiplied by (p/r)* and goes to zero as k grows infinitely large. It is evident 
that as r > oo, the Gm/r term dominates Eq. (10.12). Therefore an arbitrary 
body’s potential approaches the point mass potential as r — oo. This parti- 
tioning of the gravity potential field function is used extensively in the following 
approximation due to MacCullagh. 


10.2 MacCullagh’s Approximation 


In the following discussion we only consider an approximation to the gravi- 
tational potential field model introduced by James MacCullagh (1809-1847), 
a professor of mathematics and natural philosophy at the Trinity College in 
Dublin, Ireland. This approximation involves retaining only the first three terms 
of the infinite series expression of the gravitational potential field expression. 
Substituting the first three Legendre polynomial definitions in Eq. (10.7) into 
Eq. (10.12) yields 


V(r) & ~S" Sif p cosy dm— = | ff p*(3cosy?—1) dm_ (10.13) 
term 1 term 2 term 3 


Note that term 1 is simply the point mass contribution of the gravitational 
potential field. This assumes that the body generating the gravitation field can 
be modeled as a point with mass m. 

Next we investigate term 2. Since the orientation of the body fixed coordinate 
system C is arbitrary, we chose to let the € axis be aligned with the point P 
position vector r. In this case € = pcosy and term 2 is rewritten as 


term 2= off dm (10.14) 


If the coordinate system origin of C is constrained to be the body center of mass 
(see Eq. (2.77)), then term 2 is identified to be proportional to the first mass 
moment of the body 6 and is thus zero. 


term 2=0 (10.15) 


A more subtle truth is that when leaving term 2 out of the gravity model which 
is fit to precisely measured orbits, the coordinate origin has implicitly been 
chosen at the mass center. 

Before investigating term 3, the following body 6 inertia definitions are in- 
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troduced: 


Teg = Ile +?) dm (10.16a) 
Inn = Ile +¢°) dm (10.16b) 
Ig = ihe +1) dm (10.16c) 


A convenient identity is that the sum of J;; is the trace of the inertia matrix: 


Tee + Inn + Ice = 2/// pdm (10.17) 
B 


Further, the polar inertia of body B about the vector r is 


b= III p* sin? y dm (10.18) 
B 


Using the trigonometric identity cos? y = 1 — sin? y, the term 3 expression is 
rewritten as 





term 3 = se fff (2p? dm — 3p? sin? y dm) (10.19) 
B 


Making use of the inertia definitions in Eqs. (10.16) and (10.18), term 3 is 
expressed as the elegant form 


G 
term 3 = 5,3 (lee + Lyn + Ie¢ 31,) (10.20) 
ie 


Thus, the gravitational potential field of an arbitrary body with a body fixed 
coordinate system centered at the body center of mass is approximated as 


m 
V(r) om aa (het Ty the 3) Pu (10.21) 
Note that if the body B is spherically symmetric, then Ig¢e = Inn = Ice = Ip and 
term 3 vanishes. This result indicates that the gravitational potential field of a 
perfectly spherical object can always be modelled as that of a point mass. In 
fact, the expression of term 3 provides a measure of asymmetry of body B from 
the ideal spherically symmetric case. 
In its current form, however, the gravitational potential function approxi- 
mation is not very convenient since J, depends on the location of the external 
reference point P. To avoid this, we write J; as 


ip Ihe sin? y dm = Hee — cos? y) dm (10.22) 
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In terms of C coordinate frame components, let r = (x,y,z)? and p = (€,n, ¢)". 
Note then that cosy can be written as 


pir €&+nyt+ 
pr — pr 


cosy = (10.23) 


After substituting Eq. (10.23) into Eq. (10.22) and expanding we obtain 


1 
In = a fff [22(n? + €) + y?(E? + 0?) + 2(6? + 9) 
— 2ayEn — 2uzE¢ — 2yzn¢|dm (10.24) 


Noting that x, y and z can be taken outside of the body integral, and making 
use of the cross product of inertia definitions 


len = [ff enam (10.25a) 
lec = — | |} bam (10.25b) 


Inc = = fff cam (10.25c) 


the polar inertia of body 6 about the axis r is written as 
1 
i= 5 [Heex” + Lea ots Tecz? + 2(aylen + ezlec + yzInc (10.26) 


The advantage of this expression of J, is that it is written in terms of the in- 
ertias of B with only the (x,y,z) position of P left unspecified. Note that the 
expression in Eq. (10.22) involved computing the polar inertia for every new 
reference point P. To avoid having to keep track of the products of inertia, 
here we assume at this point that the coordinate system C is a principal coordi- 
nate system which diagonalizes the inertia matrix of the body B. Substituting 
Eq. (10.26) into Eq. (10.21), the MacCullagh Gravity Potential Approximation 
is given by 


Gm 
V(a,y, 2) = r 


G i y? 72 
eg ee(2 35) t (1 34) f Te(1 35) (10.27) 


The potential function R(r) is then approximated as 


G 72 y? 22 
Rr) = 55 ee(1 35) ! In 34) ! Tec(1 35)| (10.28) 


Note that the gravity field of the arbitrary body B is defined completely in terms 
of its mass m and its principal inertias ge, Inn and I¢c¢. Of course, in practice it 
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is rather difficult to obtain the precise inertias of a celestial body. However, it 
is possible to estimate these values by observing the natural motion of a small 
satellite about a larger celestial body. 

To compute the acceleration a, experienced by a small body in the vicinity 
of B, we compute the negative gradient of V. 


OV. OV. av 


ap(a, Y; Zz) = -VV(a,y, Zz) = Sone = Oy” i aes (10.29) 
Making use of the fact that 
1 1 
V (=) = - i, (10.30) 
r r 


where 2, is the unit directional vector r, the acceleration a is written as 


i 3G x? y? 2 5 
eae ae Tos (1s sibine ttGe/— 20 (t6e5 + Im=a t+ Leer J} ) 


3G * Z rn 
_ ae (Lee vie + Lyn Yin + Tee zic) (10.31) 


Substituting Eq. (10.26), we are able to write the acceleration in terms of prin- 
cipal inertias and polar inertia [,.. 


Gm . 3G e 
ap= Pagans — 374 (Lee + Lyn + Lee = 51,) br 


3G e “ , 
_ rs (Lee vie + Lyn Yin + Tec zic) (10.32) 


Note that the last expression of either Eqs. (10.31) or (10.32) is the non-radial 
perturbing acceleration. However, if Ig¢e = Inn = I¢c, then the second and third 
terms combine to yield zero. This reiterates that the gravitational potential 
field of a spherical body of mass m is identical to that of a particle of mass m. 


10.3. Spherical Harmonic Gravity Potential 


While MacCullagh’s approximation defines the gravity potential field in terms of 
the body inertias, an alternate approach is needed to model the general gravity 
field in terms of a spherical harmonic series. Instead of writing the infinitesimal 
body mass position components as Cartesian coordinates, the corresponding po- 
sition vector is now expressed in terms of spherical coordinates as p = p(p, A, 3) 
as shown in Figure 10.2. Analogously, the position vector of P is written as 
r=r/(r,0,¢). The angle y is the angle between the p and r position vectors as 
in the previous development. 

Recall the general gravity potential field expression in Eq. (10.12) for an 
arbitrary body B. 


V(r) = a a £é If. (2): P,(cosy) dm (10.33) 
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Close-Up View of 
Mass Element 





Figure 10.2: Gravity Potential of an Arbitrary Body using Spherical 
Coordinates 


Using the body-fixed spherical coordinates p, \ and (, the differential mass 
element dm is expressed as 


dm = D(p, X, 3)p” cos 8 dp dB dr (10.34) 


with D = D(p,., 3) being the local density of B. Since the gravity potential 
is expressed as an infinite expansion using Legendre polynomials depending on 
cosy, it is convenient to express cosy as a function of the angular coordinates 
of the p and r position vectors. Using the spherical trigonometric law of cosines 
we write 


cos y = sin dsin 3 + cos dcos 3 cos(@ — X) (10.35) 


To further facilitate the development of the gravitational spherical harmonic 
series, we make use of the definition of the associated Legendre Functions.+ 
je 

dvi 


Nir 





Pi) = (1-v?) (P.(v)) (10.36) 


The parameter 7 is referred to as the order of the associated Legendre function, 
while & is referred to as the degree. Note that zeroth order associated Legendre 
functions are simply the Legendre polynomials. 


P2(v) = Py(v) (10.37) 
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Further, since P,(v) is a polynomial expression of degree k, then 
PaO Sk 


must be true. The associated Legendre functions for Legendre polynomials up 
to third degree as explicitly given as: 


Pliv)=V1—-v? Phy) =3vV1—-v?— Pv) = 5 V1 (5? 2°) 
(10.38a) 
P2(v) = 3(1 —v?) P3(v) =15v(1—v?) —_(10.38b) 
P3(v) =15(1—v?)? — (10.38c) 


For our present study we set v = sina. The corresponding associated Legendre 
functions up to second degree are 


Pi (sina) = cosa (10.39a) 
P3(sina) = 3sinacosa (10.39b) 
P3 (sina) = 3cos? a (10.39c) 


Notice that the first Legendre polynomial can now be written in terms of asso- 
ciated Legendre functions by making use of the spherical trigonometric identity 
in Eq. (10.35). 


P,(cos y) = cosy = P,(sin ¢)P;(sin 8) + P} (sin ¢)P; (sin B) cos(@ — A) (10.40) 


To write the second Legendre polynomial in terms of associated Legendre func- 
tions, we first express cos? 7 as 


1 
cosy = 5 (3 sin? sin? @ — sin? ¢ — sin? @ + 1) 
1 
a cos” cos” 3 cos (2(@ — A)) + 2sin cos dsin Bcos Bcos(9 — A) (10.41) 
Using Eqs. (10.39) and (10.41), the second Legendre polynomial is expressed as 


P2(cosy) = =(3.cos? y — 1) = Po(sin ¢) Po(sin 3) 


NIlR 


+ 5P (sin ¢) P3 (sin 3) cos(@ — 2) 


+ ss Pi(sin )P3(sin 3) cos(2(9 — )) (10.42) 


Carrying these expansion to higher degrees leads to the general addition theorem 
for Legendre polynomials.+ 


P,(cos y) = P,(sin ¢) P;,(sin 8) 





k ‘ 
2 + zt 2. Pi (sin ¢) Pi (sin 8) cos(j(8— )) (10.43) 


j=1 ; 
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Substituting Eq. (10.43) into Eq. (10.33), and making use of the trigonometric 
identity 
cos(j(@ — A)) = cos j@ cosjA+sinj@ sin jr 


the gravitational potential field is expressed in terms of spherical coordinates as 


Gm — 
V(r, ¢,8) = ras Soa ea mr (AnPe(sin @) 
k=1 
ko . | 
+ }> Pi (sin 6) (Bj cos j + Cfsinj@)) (10.44) 
j=l 


with the coefficients A; (zonal harmonics) and Bj and Cj (sectorial harmonics) 
defined as the following (k + 2)-th degree mass moments 


Ay = eff. p**? D(p, A, 3)Px(sin B) cos B dp dB dr (10.45a) 





Bi =208 = Ill, p+? D(p, d, 3)Pi (sin 8) cos j\.cos 8 dp dB dd (10.45b) 











(k 4 
Cj =2G 7 — a lf p**? D(p, A, 3) Pi (sin B) sin jA cos B dp dB dX (10.45c) 
A B 
Note that the gravity potential field expression in Eq. (10.44) separates the 
position coordinates which depend on the body B mass distribution (i.e. Ax, 
Bj, and CZ) and the those which depend on the location of P (i.e. ¢ and 6). 
Consider the body integrals of Eq. (10.45). If these integrals vanish, ob- 
viously the gravitational potential field expression in Eq. (10.44) reduces to 
—Gm/r. This occurs if the density is a function of p only; or, in other words, 
when the body B is spherically symmetric with D = D(p). To establish this 
result, let us first investigate the integrals for the common case where the body 
is assumed to have an axis of symmetry. We chose this axis to be i¢. This 
means that the density D(p, A, ) = D(p,) does not depend on the longitude 
d. Evaluating the ) integral first, Bf and C/ are expressed as 


2 
pia) aa eat [fob p, 3) P; (sin B) cos 8 d@ dp (/ cos()d) 
(10.46) 
(k- a) pPprr?, i oaks 
ofan Fa) [fd *? D(p, 3) Pi (sin 8) cos B dB dp (/ sin(jA)a) 
(10.47) 


where R is the outer most radius of the body B. Since both integrals are zero, 
we come to the conclusion that 


Bea OA 0  (¢ D= Dipep) (10.48) 
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for any body of revolution (i.e. cylinders, ellipsoids, etc.). Thus Bi and Gf are 
only non-zero if the body density depends on the longitude X. 

Investigating the integral A,, we assume at this point that the body B is 
spherically symmetric with D = D(p). Performing the longitude integration 
first, we are able to write Ax as 


R n/2 
Ay = 20G ( i oh D1p0) ( / P,(sin 3) cos na) (10.49) 


0 —1/2 


Using the variable v = sin @, this integral is rewritten as 


A, = 2G ie e019) Gy P.(e)dr (10.50) 


Using the Legendre polynomial zero mean condition in Eq. (10.9), the integrals 
Ax are found to be zero for the spherically symmetric body case. 


Ap= BL =CL=0°  ND=D(p) (10.51) 


Example 10.1: Imagine a planetary body which is hollow. In this example 
we investigate what the gravity potential field will look like if a person is 
inside this planetary body. The gravitational potential field of differential 
mass element dm is given in Eq. (10.11) for the case where r > p and the 
point of interest 7 is entirely outside of the planetary body. If the point of 
interest is inside a hollow body and r < p, then we rewrite the differential 
potential field expression in Eq. (10.5) as 


Gdm 
a 1/2 
o(1+(z) ~2(4) cos’) 


Since r/p < 1, we are able to use the Legendre polynomial identity in 
Eq. (10.6) to express the differential potential field of dm as an infinite series. 


dV (r, p,y,dm) = — (10.52) 


Gdm Sa [r\* 
dV (r,p,y,dm) = ae (£) Px (cos 7) (10.53) 
k=0 


Integrating over the entire body 6, the gravitational potential field V(r) is 
given by 


vin [f-dam-0 & [35 reorsin cvs 
- k=1 


where the point of interest 7 interior to the hollow body. For the standard case 
where r > p the term Vo becomes the standard inverse-square gravitational 
attraction of a point mass. Note that for the present case where r < p this 
term becomes a constant of the body B. The function Vo only depends on 
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Figure 10.3: Illustration of a Spherically Symmetric Shell-Shaped Plan- 
etoid 


the body element position vector p and not on the position vector r. Since 
Vo = Vo(p) only, the gradient of Vo with respect to r will always be zero 
for this case and Vo will not contribute any gravitational acceleration for any 
point r interior of the hollow body B. 


Let us use the Legendre polynomial identity of P, (cosy) in Eq. (10.43). This 
allows us to write the general potential field expression of an interior point of 
a hollow body using spherical harmonics. 
V(r, 6,0) = Vo— Yor*( An Pe(sin 6) 
k=1 
+ S- Pi(sin ¢) (Bi cos j0 + Ci sin j0) ) (10.55) 


j=l 


with the body specific components Ax, Bi and ci begin defined as 
Ay = eff a= D(p,X, 8) Px (sin 8) cos 8 dp dB dX (10.56a) 
Bi = cu ff os D(p, A, 3).P? (sin 8) cos jcos 3 dp dZ dd (10.56b) 


C= Gus fff sa D(p, A, 3) P2 (sin 8) sin jA cos B dp dd (10.56c) 
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with Gz; being defined as 


Giz = 2G a (10.57) 





Equivalent arguments regarding Ax, Bi and ct can be made as were done 
for the case where r > p. If the density function satisfies D = D(p, 3), then 
Bi and c will always be zero. This density function condition applies to any 
body of revolution. Ellipsoids and sphere would be examples of such bodies. 
Further, if the density function satisfies D = D(p), then the gravitational 
parameter Ax will also be zero. An example of this would be a spherical shell 
as shown in Figure 10.3. Note that in this case the gravitational potential 
field V(r) experienced at any point r in the interior of this shell will be 
the constant Vo. Since the gravitational acceleration is the gradient of the 
potential field function with respect to r, the gravitational acceleration will be 
zero for any interior point. Assuming the spherically symmetric shell shown in 
Figure 10.3 has a homogenous density D, the constant gravitational interior 
potential Vo is 


Vo = —GD2n (p5 — p7) (10.58) 


A spacecraft inside this shell planetoid will be attracted to the planetoid mass. 
However, the various gravitational forces will cancel each other at any interior 
point due to the symmetry of the planetoid body. 


If the origin of the coordinate system C is the body mass center, it can be 
shown that A; will always be zero. To do so, we substitute the dm definition in 
Eq. (10.34) into Eq. (10.45a) with & set to 1. 


vie [ff sins an (10.59) 


Using analogous arguments that lead to Eq. (10.14) being zero, it is clear that 
A, is always zero if the coordinate system origin is at the mass center. 

For a body with rotational symmetry, the gravitational potential field func- 
tion V is then expressed as the sum of the point mass contribution and the 
zonal harmonics. 

CO 
Vows sS Sa AnPa(sin d) (10.60) 


r 
k=2 





Note that the rotation of this body about the symmetry axis does not affect the 
gravity field. The physical reason is that the mass distribution is not changed 
when a symmetric body is rotated about it’s symmetry axis. As a consequence, 
if rotational symmetry is assumed, Earth rotation does not change the gravity 
field and this greatly simplifies the equations of motion. 

The conventional notation in the orbital mechanics literature for the zonal 
harmonics is 


ea (10.61) 
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with reg being the equatorial radius of body B. The gravity potential V now 
takes on its most famous for: 


Gm 


r 


V(r, a) ae 








it s> (“)' Jp Pr (sin 3) (10.62) 


k=2 


Note that as the point P moves away from the body B (i.e. r — oo), the effect 
of the zonal harmonics diminish to zero quickly. 

Practically speaking, it is essentially impossible to obtain values for J, by 
integration of its analytical expression, because we do not have an accurate 
knowledge of the Earth’s mass distribution D(p, 4, 3). Instead, these coefficients 
are typically obtained by observing the motion of a satellite about the body and 
then extracting these harmonics through an estimation method. For the Earth, 
the first six zonal harmonics are given by! 2 


Jz = 1082.63 107° 
J3 = —2.52 107° 
J4= —1.61 10° 
Js = —0.15 10-° 
Je= 0.57 107° 


The Jz harmonic, also referred to as the oblateness perturbation, is clearly the 
dominant harmonic. It causes a highly noticeable precession of the near-Earth 
satellite orbits. 

Setting uw = G m, the gravitational perturbation function R(r) for the J2 
through Jg gravitational perturbations is then given by 





2r 
- 24 ("4 (5sin @ 3sin 6) 
-38 (ay (35 sint ¢ — 30 sin? $ + 3) (10.63) 
Bee 63sin® $ — 70sin® + 15sin¢) 


231 sin® ¢ — 315 sin* ¢ + 105 sin? ¢ — 5) 


Computing the gradient of R(r) and making use of z/r = sin ¢, the perturbing 
acceleration aj, due to J; is given in terms of inertial Cartesian coordinates as:? 


beets) le 
e225 (5) (=) | @-5@’)# (10.64) 
3—5(%))% 
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; Af EG) eG) e 
ee (4) (=) Brey 226) )\2 (10.65) 
3 (10 (3)’- $3)" -1) 
3—42(3)° +63(3)") $ 
5 : 
ay, =—2Jy (4) (=) 3 — 42 (2)? +63 (2)*) 2 (10.66) 
— (15 — 70 (2)’ +63 (3)") ¢ 
3 (35 (F) 210 (3) +231 ()") ¢ 
J bt Te 5 Zz Zz z 
as, =~ (4) (=) | 3(35(¢) -210(2)*+ a yu (10.67) 
(15 — 315 (2)"4 945 (2)*— 693 ()°) 
35 — 945 (2)"4+ 3465 (2)*— 3003 (2)°) £ 
J L Te z\2 z\4 z\6 
ay, = (5) (=) | (35-945 (2)’+ 3465 (2)"- 3003 (2)°) # | (10.68) 


(3003 (2)°— 4851 (2) "+ 2205 (2)"- 315) 2 


Example 10.2: The J; induced gravitational acceleration vectors in Eq. (10.64) 
— (10.68) are developed with components taken in a Cartesian coordinate 
frame {iz,7y,%z}. In this example we take the gradient of the gravitational 
perturbation function R(r) in Eq. (10.63) using the spherical coordinates 
(r,@,0). Let S be a coordinate frame defined through {7,,, 26, is} as shown in 
Figure 10.4. The acceleration experienced due to the gravitational potential 





Figure 10.4: Illustration of Spherical Coordinates and the Coordinate 
Frame Unit Direction Vectors 
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R is given by 


gop Cee, pit OR, 
— ~ Or” r Oo ® rcosd 00” 


Note that the pertubance potential R does not depend on the longitude 
angle 0, thus their will be no acceleration component in the zg direction. The 
perturbation acceleration vectors aj, due to J; are expressed in terms of the 
spherical coordinate frame unit direction vectors as: 


aie = —SJana (3 cos(2) — 1)ép + 2sin(26)i6| 
pe — Fens [(20 sin(3d) — 12sin ¢)é, 

— (15 cos(3) — 3.cos d)ie| 
ge a [(-35 cos(4¢) + 20 cos(2¢) — 9), 


64 
— (28 sin(4¢) — 8sin(2d))io| 


aj; = — sop Jors [2(-63 sin(5¢) + 35 sin(3¢) — 30sin ¢)é, 
+ (105 cos(5¢) — 35 cos(3¢) + 10 cos oyio| 
aj, = — zone [(221 cos(6¢) — 126 cos(4@) + 105 cos(2¢) — 50)i, 


+ (198 sin(6d) — 72 sin(4¢) + 30 sin(2¢))io| 


with «; being defined as 


10.4 Multi-Body Gravitational Acceleration 


In chapter 9 the equations of motion for the three body problem were discussed. 
It was shown that if a body has a small small mass compared to the other two 
bodies, then it would essentially abide by Keplerian motion in the vicinity of 
either remaining body. For example, the motion of a satellite in near Earth 
orbit is dominated by Earth’s gravitational attraction. However, the Moon 
does cause a small perturbation of the orbits. The acceleration experienced 
by the spacecraft due to the Moon can be viewed as a result of a disturbing 
potential function. This section will provide the general equations of motion for 
a multi-body system of point masses and derive such a multi-body perturbative 
potential function. 

In the following development, let m be the primary mass about which a 
second mass mz is orbiting. The remaining masses m; (with 2 <i < N) are 
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assumed to be close or massive enough to have an effect on the (m1, mz) two- 
body solution. Using Eq. (9.3), the equations of motion for m,, m2 and m; 
are 





N 
r= Gerry + cy wry (10.69) 
"12 j=3 1d 
N 
r2 = Gtr + cy> ory; (10.70) 
P21 ra "5 
N 
7, = Gye in summed for i 4 j (10.71) 
ja 


with the relative position vector rj; being defined as 


Tig = TIT (10.72) 
Using the position vector property ri; = —1rj;, the equations of motion of m2 
relative to m1 are 
my+tm x r r 
é3 1 2 5 1j 
T12 = G 23S 12 + Ss m5 = = — (10.73) 
"2 j=3 [5 15 


Expressing all position vectors relative to m1, the equations of motion of m2 
are given by 


G(m1 + m2) T1,-7 r 
2 1 2 lj 12 lj 
ASE SES, = y got de EE ah 10.74 
Tig + 5 T1292 =G ms ( 5 “| (10.74) 


12 P= 24 "5 





ad 


Note that the left hand side of Eq. (10.74) is the result of the standard Keplerian 
motion between masses m; and mz. The right hand side forms the perturbative 
acceleration @q away from this solution. No assumption has been made here as 
to whether this acceleration is small or large. Further, note that the mass index 
labeling has been setup arbitrarily here. By switching the indices, the equations 
of motion provided in Eq. (10.74) are applicable to any of the N bodies. 

Assume that the N-body system consists of the Earth (m1), the Moon (m2) 
and the Sun (ms), and we are interesting in the motion of the Moon relative to 
the Earth. As seen in Table 8.2, the Sun is at least 10° times more massive than 
either the Earth or the Moon. At first glance then, it would appear as if the 
perturbative acceleration aq would be very large in this case. However, since 
the relative distances r23 and r13 are almost identical, then the effect of the 
Sun’s gravitational attraction on the relative motion of the Moon to the Earth 
is very small. In essence, the Earth-Moon system are approximately free-falling 
together around the Sun. 
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The disturbing potential function generated by mass mj; on the motion of 
mg is given by! % 


1 sae 
R;(riz) = Gm; (+ ae 4] (10.75) 


123 "7; 


To verify that this potential function does lead to the previously derived pertur- 
bative acceleration ag, we need to compute the gradient of the scalar distance 
[29+ 


Ore; 


0x2 
Ora; 125 T1j —T12 

Vroj = at Se ee (10.76) 
Ora; 125 125 


0z2 








Making use of Eq. (10.76), we find that indeed 


N 


ag = S_VRj(ri2) (10.77) 
j=3 


10.5 Spheres of Gravitational Influence 


Consider the classical two-body problem where one relatively small object of 
mass m, such as a man-made spacecraft, is orbiting about a relatively massive 
object of mass m, such as the Earth. Depending on the relative energy of m to 
my, the relative orbit of m will be one of the three conic solutions discussed in 
chapter 8 (i.e. either be elliptic, parabolic or hyperbolic). If additional celestial 
objects are present, then the precise motion of m relative to m , is no longer 
the classical two-body solution, but rather a trajectory which is perturbed from 
this two-body solution. For example, consider a satellite in Earth orbit with the 
Moon acting as the additional celestial body. The gravitational influence of the 
Moon will cause slight perturbations to the nominal two-body solution of the 
satellite orbit. However, the closer the satellite orbit is to the Earth, the smaller 
the gravitational perturbation would be. Thus, for a very low Earth orbiting 
satellite, the lunar gravitational effect could be ignored, since the satellite mo- 
tion is overwhelmingly dominated by the Earth’s gravitational attraction. As 
the satellite travels between the Earth and Moon, however, the lunar effect must 
be included when determining the satellite orbit. This concept is evident math- 
ematically in Eq. (10.74) where the equations of motion for a multi-body system 
are defined with the additional gravitational effects written as a disturbance to 
the classical two-body solution. 

Treating the gravitational acceleration of additional bodies as a perturba- 
tions leads to the concept of defining a sphere of influence about a particular 
celestial body. These spheres are regions around celestial objects where the par- 
ticular object’s gravitational attraction will largely determine the trajectory of 
any other small mass within its vicinity. The gravitational attraction due to any 
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remaining objects would typically be very small within the sphere of influence. 
Thus, as an initial approximation of the multi-body problem, the gravitational 
effect of the remaining bodies is ignored while a small object resides within such 
a sphere of influence. This idea is illustrated in Figure 10.5 where a conceptual 
trajectory is shown of a satellite traveling from Earth to Mars. The spheres of 
gravitational influence of Earth and Mars are illustrated as transparent spheres 
around each planet. Note that the Sun also possesses a sphere of influence. How- 
ever, the Sun’s region of attraction is so large that it encompasses the entire 
solar system. Thus, if any object is outside the sphere of influence of a planet, 
it is by default assumed to be under the dominant gravitational influence of the 
Sun. The spacecraft motion shown in Figure 10.5 begins close to Earth. The 
craft has enough energy relative to the Earth such that it is on a hyperbolic 
escape orbit. This trajectory description is reasonably accurate up to the point 
where the craft departs the Earth’s sphere of influence. From here on its motion 
is dominated by the gravitational influence of the Sun. Assuming the spacecraft 
doesn’t have enough energy relative to the Sun to be on an escape trajectory, 
its orbit can be described by a heliocentric ellipse. At a later point of time the 
craft enters the sphere of influence of Mars, whose gravitational attraction will 
determine its orbit from here on. Since the velocity ” far from Mars” is non-zero, 
we can be certain the motion relative to Mars will be hyperbolic. 

Note that with this approximation, the spacecraft motion within a particu- 
lar sphere of influence is solely described through two-body conic intersections. 
Since the entire trajectory of the spacecraft through the multi-body gravita- 
tional field is approximated as a series of conic solutions (i.e. locally elliptic, 
parabolic or hyperbolic relative orbits), this method of determining the trajec- 
tory is referred to as the method of patched conics. As the name describes, the 
various conic solutions are patched together to find an approximate solution to 
the multi-body problem. 

To express the sphere of influence concept in mathematical terms, we rewrite 
the multi-body equations of motion in Eqs. (10.74). Let m and mz be celestial 
bodies, while m is a spacecraft with m << m, and m < mg. The position vector 
of m relative to m,; is given by r;, while the position vector from body 7 to body 
j is given by rj; as illustrated in Figure 10.6. Defining p; = G’m;, the equations 
of motion of m relative to either m1 or mg are given by 


r 
#=-Sry —p (3 + “) (10.78) 
TY T Tie 
at ad, 
a b2 T1 T12 
T2 = —-WzT2 —-H1 (5 = “) (10.79) 
8 a 
——S Oe” 
a2 ad 


In each case, the gravitational attraction of the other celestial body is expressed 
as a disturbance acceleration ag, on the two-body solution about m;. The sphere 
of influence is defined as the vicinity around m; where the disturbance vector 
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Figure 10.5: Approximating a Trajectory Among Multiple Bodies 
Through Spheres of Influences 


m Sphere of Influence 


mM, 





Figure 10.6: Gravitational Spheres of Influence 
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Qa, is of the same magnitude as the two-body acceleration vector a;. Assuming 
that the mass m2 is smaller than the mass mj, this surface about mz can be 
approximated as a sphere. The radius r of this approximate spherical surface is 
determined through the formula? * 


mo \ 2/5 
r= (=) re (10.80) 


Using the planetary mass coefficients in Table 8.2, the sphere of influence radii 
of the solar system planets are computed in Table 10.1. 


Table 10.1: Spheres of Influence Radii of the Solar System Planets Rel- 
ative to the Sun Gravitational Influence 


Average Orbit | Approx. Sphere 


Planet Radius [km] _ of Influence [km] 
Mercury & 57,910,000 112,500 
Venus 9 108,200,000 616,400 
Earth ® 149,600,000 916,600 
Mars CO 227,940,000 577,400 
Jupiter 2; 778,330,000 48,223,000 
Saturn h 1,429,400,000 54,679,000 
Uranus 6 2,870,990,000 51,792,000 
Neptune Y —4,504,300,000 86,975,000 
Pluto B 5,913,520,000 15,146,000 


Note that the spheres of influence around a planet grows larger as the planets 
mean orbit radius increases, and thus the local gravitational influence of the Sun 
diminishes. This is how the Saturn sphere of influence radius rp is larger than 
the Jupiter sphere of influence radius rz. This is true even though Jupiter is 
much more massive than Saturn. 


Problems 


10.1 Use the binomial expansion theory to verify the Legendre polynomial identity 
given in Eq. (10.6). 


10.2 Verify the derivation of gravitational acceleration expression given in Eq. (10.32) 
by starting with Eq. (10.29) and showing all steps in between. 


10.3. Verify that Ize = Inn = Ice does reduce the gravitation acceleration to be 


G. 
ap = - Zr 
P 2 
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10.4 & Consider a planet spinning at a constant rate w about its polar axis 7¢. Assume 
that the planet is an ellipsoid of revolution with the inertia’s [gg = Inn and Ice. 
The motion of a particle on the planet’s surface is studied in this problem. 


a) Show that for this case the MacCullagh Gravity Potential Approximation 
is given by 


ope tite Gr lem TEEN fas 3 28 
V(r) ~y Se + ys (3sin o- 1) 

b) Write the equations of motion of a particle located at r = (r,¢,0) on 
the planet’s surface using the unit direction vectors {7,,%9,%¢} shown in 
Figure 10.4. If the planet’s surface is frictionless, in what direction would 
the particle slide? 


c) Establish that the modified potential function V’ = V — srw cos? 
provides the measured gravitational acceleration of this particle on the 
planet’s surface. 


d) Assume that I¢¢ < Ige (Note: this is not typically the case). Consider 
the approximation r ~ re(1 + 7) of the radial distance of the particle 
with respect to the planet’s center with 7 << 1, where r, is the planet's 
equatorial radius. Assuming a frictionless planet surface, establish the 
condition for equilibrium such that the particle will remain fixed as seen 
by the rotating planet reference frame. 
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CHAPTER ELEVEN 


Perturbation Methods 





While on the macroscopic scale unpowered spacecraft and celestial bodies typ- 
ically prescribe elliptic, parabolic or hyperbolic trajectories, on the small scale 
every body is suspect to minor disturbative accelerations. Precise orbit calcula- 
tions require us to account for these perturbations. For example, perturbations 
could be due to the gravitational attraction of other celestial bodies, the non- 
spherical shape of planets, atmospheric drag or solar radiation pressure. While 
these affects are usually relatively small compared to the dominant point mass 
gravitational attraction, they do have an important impact when studying the 
long-term behavior of these orbits. 

Most perturbations methods have in common that instead of directly nu- 
merically integrating the orbits themselves, only deviations from a two-body 
solution are studied. This allows us to separate the large effect of the domi- 
nant point mass gravitational field from the small effect of the disturbance and 
enables the use of analytical approximations. In the mid 19-th century, both 
the English astronomer John Couch Adams (1819-1892) and the French as- 
tronomer Urbain-Jean-Joseph Le Verrier (1811-1877) independently used the 
method of variations of parameters when studying the irregularities of the mo- 
tion of Uranus.' Their amazingly precise observations and calculations predicted 
the existence of a then unknown planet Neptune which was causing the observed 
deviations. In 1846 both were able to detect Neptune within one degree of the 
predicted position. After Le Verrier became director of the Paris Observatory 
in 1854, he began to study the motion of the planet Mercury. He found that 
this planet’s orbit had similar irregularities as he found in Uranus’ trajectory. 
He thus predicted the existence of new planet closer to the sun, which he name 
Vulcan. However, after his death the wobbles in the motion of Mercury were 
later explained using Einstein’s general theory on relativity without the need to 
introduce a new planet. 

This chapter will first discuss Encke’s method to introduce the ideas of per- 
turbation induced departure motion. Following this a general procedure called 
the variation of parameters is discussed which is mathematically more chal- 
lenging, but provides very valuable algebraic insight into the effects of these 
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disturbances on the various evolutions of orbits. Finally, the state transition 
matrix is introduced. This matrix is often used in dynamics and control the- 
ory to predict the departure motion of an object relative to a nominal motion 
trajectory if small perturbations are present. 







to r(to) 


actual perturbed 


osculating orbit 


reference 
orbit 





Figure 11.1: Illustration of Encke’s Method 


11.1 Encke’s Method 


The relative equations of motion of a mass mz relative to m, was found in 
Eq. (8.42) to be 


x LU 
TS sgt t+ Ga (11.1) 


where r = rg — r; and aq is the perturbative acceleration defined in Eq. (8.43). 
To directly numerically integrate these equations of motion is commonly referred 
to as Cowell’s Method. This is the preferred method, as compared to analytical 
approximations, if the perturbative acceleration vector aq is changing generally 
and is of the same order of magnitude as the dominant gravitational accelera- 
tion. However, in many applications ag is orders of magnitude smaller than the 
dominant gravitational force. For example, for a satellite in a low Earth orbit, 
the dominant Earth oblateness effect is three orders of magnitude smaller than 
the spherical Earth gravity field acceleration. Other effects such as solar radi- 
ation drag, atmospheric drag and the gravitational pull of the moon are even 
smaller. Using Cowell’s method to solve the equations of motion accurately 
captures the small deviations from the two-body Keplerian solution; however, 
this numerical solution takes no advantage of the nearness of the motion to the 
analytically solvable two-body case. 

The guiding principle of Encke’s method is to use the known, closed-form 
Keplerian solution to compute the dominant trajectory, and then numerically 
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solve a second differential equation for the deviations 6 from the two-body 
solution. This concept is illustrated in Figure 11.1. At time to the reference 
Keplerian orbit is established using the instantaneous r(to) and r(to) vectors. 
This reference orbit is referred to as the osculating orbit since at to it “kisses” 
or osculates the actual orbit at to. 


r(to) = Tosc(to) r(to) — Posc(to) (11.2) 


Therefore, the two orbits only differ in their mutual curvatures at time to due 
to the different acceleration expressions. The positions and velocity vectors of 
each orbit will be identical at to. The true trajectory is given by the differential 
equation in Eq. (11.1). The osculating orbit is determined through 


Lb 





Pose a) Tosc (11.3) 
Defining the orbit deviation 6 to be 
6 =P — Tose (11.4) 


the relative equations of motion of the actual orbit compared to the osculating 
orbit are given by 





B= — Fone =u (7 -5) + aa (11.5) 
r 


3 


Adding and subtracting r/r3,, terms and using Eq. (11.4), the 6 expression is 


rewritten as 














3 
< Lt Lt Tose 
b= 8-5 (Bea) eta oem 
Defining the scalar function f to be 
a 
f(?, Tose) = 3° —1 (11.7) 
r 
the deviation equations of motion are written in their final form as 
i -+ (6+ f(r, Pose)") + aa (11.8) 


OSC 


Unfortunately computing the function f directly using the algebraic expression 
in Eq. (11.7) is numerically challenging since two essentially identical numbers 
are subtracted from another. To compute this term without having to resort 
to higher precision arithmetic, it is possible to rewrite the function f() into a 
more convenient form. Let us define the scalar parameter q as 


6:-d6—26-r 


; (11.9) 


iQ 
Il 


r 
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where it is easy to show from Eq. (11.9) that 


ress 

“ee =14q (11.10) 
Substituting Eq. (11.10) into the f() expression in Eq. (11.7) and multiplying 
and dividing the result by (1 + (1 + q)3/), we are able to express f() directly 
in terms of g without subtracting any near-equal numbers in the following form 


34+ 3¢+¢ 


I) = ITT 


(11.11) 


Let’s summarize Encke’s method. At time to the osculating orbit is setup 
invoking the conditions in Eq. (11.2) and the conditions 


(to) = d(to) =0 (11.12) 


From here on, osculating position and velocity vectors rosc and Mose are com- 
puted using the 2-body solution such as the F and G functions. The deviation 
position and velocity vectors 6 and 6 are computed by numerically integrating 
Eq. (11.8) twice. The actual orbit position and velocity vectors r(t) and 7r(t) 
are then computed through 


r(t) = Tose(t) + 5(t) (11.13) 
#(t) = Pose(t) + 6(t) (11.14) 





The result is a natural splitting in the computation of the 2-body and distur- 
bance components. For systems with a relatively small aq vector, this allows 
larger integration step sizes to be used than if Cowell’s method were employed. 
If the deviation vector 6 grows too large at time t1, then the osculating orbit 
conditions are reset and a new 2-body reference orbit is found which osculates 
with the current r(t) and 7(¢). This process of resetting the reference osculating 
orbit is called orbit rectification. Given a chosen small tolerance €, a common 
method to determine whether or not to rectify the osculating orbit is to see if 


e (11.15) 














The newly rectified osculating orbit will again “kiss” or osculate the actual orbit 
at time t1. 


11.2 Variation of Parameters 


The method of variation of parameters can be viewed as the continuous limit 
of rectification of an osculating orbits at each instant of time. Given the in- 
stantaneous inertial position and velocity vectors r(t) and 7(t) of the perturbed 
problem, we can always compute a corresponding set of six instantaneous orbit 
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elements e; as is discussed previously in Chapter 8. However, for this perturbed 
problem the six orbit elements will no longer remain constants, but become time 
varying parameters. These instantaneous orbit elements, whose corresponding 
keplerian 2-body orbit kisses the current perturbed orbit, are referred to as the 
osculating orbit elements. 


11.2.1 General Methodology 


Assuming the scalar parameters e; are integration constants of an un-perturbed 
motion, then the method of variation of parameters seeks a corresponding set of 
differential equations for é; such that the perturbed motion description instan- 
taneously has the same algebraic form as the unperturbed motion. We would 
like the only difference between the solution of the perturbed and un-perturbed 
problem to be that the elements e;(t) are time-varying. For example, the pa- 
rameters e; could be the initial conditions of a general dynamical problem or 
the six orbit elements of a Keplerian two-body solution. 

Let x be a N-dimensional position vector. Since mechanical dynamical sys- 
tems are second order, the solution will have have 2N integration constants e;. 
Let the 2N x 1 vector e be defined as 


e=(e1,:+* ,€2n)* (11.16) 


In general, the un-perturbed solution of a dynamical system can be written as 


u(t) = f(t,e) (11.17) 
&(t) = tt, e) = of (11.18) 
&(t) = Tite) = ft (11.19) 


The last steps in Eqs. (11.18)and (11.19) hold since the elements e; are constants 
for the un-perturbed problem. Using variation of parameters, we seek a solution 
of the perturbed motion which has the same algebraic form, so we require 


a(t) = f(t, e(t)) (11.20) 
da(t) Of 
Ee = ap he) (11.21) 


This is analogous to the osculating conditions used to compute Encke’s method 
in Eq. (11.12). These conditions force the perturbed and the osculating un- 
perturbed solutions to have the same position and velocity vector, the only 
difference will be in the acceleration expression where the perturbative acceler- 
ation @q appears. 


Ga OF. 


Wee a pe 1 oe (11.22) 
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To enforce the osculation condition and the equations of motion, the elements 
e; are now treated as time-varying parameters. With e = e(t), the chain rule 
of differentiation provides 





dat) _ of , o2) de (11.23) 


dt Ot _' | de| dt 
Comparing Eqs. (11.21) and (11.23), it is evident that for the perturbed and un- 


perturbed solutions to have the same velocity expression, the following condition 
must be true: 


Of | de 
—|—=-0 11.24 
BA dt mee ( ) 
Eq. (11.24) provides N “osculation” constraints that the differential equations 
é; must satisfy. The second set of N constraints required to determine é is 


found through the acceleration expression. Taking the derivative of Eq. (11.21) 
we find 





eo de 


@ ~ 02 * |ae| a n28) 


Comparing Eqs. (11.22) and (11.25) we find the remaining N constraints on é 
to be 


so tee (11.26) 


dtde| dt 


Combining Egs. (11.24) and (11.26), the coupled osculating conditions on é are 
written compactly as 





ld ys Ong 
# = = |Llé= | N | (11.27) 
Otde 


where the 2N x 2N matrix [L] is referred to as the Lagrangian matrix. Note 
that this [LZ] matrix, as defined in Eq. (11.27), is generally fully-populated and 
may depend explicitly on time. The desired differential equations é€ are now 
found by inverting the matrix in Eq. (11.27). For many applications such as 
the perturbed two-body problem, a compact analytical inverse of this matrix 
is possible. Lagrange developed a very elegant process called the Lagrange 
Brackets that facilitates this process as is shown in the next section. 


Example 11.1: Let us illustrate the basic concepts of variation of parameters 
by attempting to solve the forced linear oscillator 
&=—w'e + aa(t,x,@,...) 


with the initial conditions x(0) = wo and «(0) = %o. For the un-perturbed 
case, a well-known closed-form solution exists for this oscillator problem. Let 


SECTION 11.2 VARIATION OF PARAMETERS 395 


us choose to write the un-perturbed motion x(t) and associated velocity «(t) 
as 


xo. 
x(t) = xo coswt + — sinwt 
w 
a(t) = —waxo sinwt + &o coswt 


For this scalar system there are only two integration constants e;, namely the 
initial conditions xo and xo. Therefore we choose to set 


€1 = Zo €2 = Xo 


Using the method of variation of parameters, we seek for the solution of the 
perturbed system to be of the same algebraic form as shown above for the 
un-perturbed system, with the exception that xo and %o are now treated as 
time-varying parameters to compensate for the perturbations. In essence, we 
are trying to find differential equations for e1(t) and e2(t) such that 


(t) 


a(t) = e1(t) coswt + ON") sin wt 
w 


a(t) = —we,(t) sinwt + e2(t) coswt 


holds for the perturbed system. To write the motion x(t) in the form of 
Eq. (11.17) we define f to be 


C2... 
f =e1coswt + —sinwt 
Ww 


Computing the necessary partial derivatives of f as required in Eq. (11.27), 
the osculating conditions on é are given by 


cos wt 4 sinwt éi\ (0 
—wsinwt coswt é2)  \aa 


Inverting the 2 x 2 matrix, the desired differential equations for xo and xo are 


é go z sin wt | a 
Se SS si 
dt Ww 2 


dx&o 
dt 
Given a perturbative acceleration aq, these differential equations show how 


the initial conditions xo and xo have to be adjusted for the algebraic form of 
the un-perturbed solution still to hold. 


é2 = = (coswt) aa 


11.2.2 Lagrangian Brackets 


Lagrange developed a convenient method to calculate the various elements of 
the Lagrange matrix [L] called the Lagrangian brackets. His method leads to 
a matrix [L] which is sparsely populated and thus easy to invert. We will 
develop these brackets here using a Keplerian orbit as the example. Assume 
all perturbations experienced are conservative and can therefore be modeled 
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through a scalar disturbance potential function R, where R = R(r) only. The 
potential energy V per unit mass of the system is then given by 
V(r) = -£ — R(r) (11.28) 


where r is the instantaneous orbit radius. The equations of motion for this 
system are given by 


“ =v (11.29) 
dv aV Ul aR)" 


Note that the partial derivative of the disturbance potential function R with 
respect to the position vector r is the same as the previously defined disturbance 


acceleration ag. 
aR\" 
—| =a 11.31 
| Or | q ( ) 
We have seen that for Keplerian motion, the orbit shape and orientation is 
parameterized by six orbit elements. Therefore, let the 6 x 1 vector e contain the 
six orbit elements. Which set of six elements is chosen is of no consequence in 
the general development. If the disturbance potential function R were zero, then 
these six orbit elements would remain constant. Using the F' and G solution, for 
example, we are able to write the instantaneous position and velocity vectors as 
functions of the constant orbit elements and time. 


r=r(e,t) v = v(e,t) (11.32) 


However, in the presence of the the disturbance potential function R, the cho- 
sen six orbit elements will vary with time. Using variation of parameters, we 
again seek a solution to the perturbed problem whose instantaneous position 
and velocity vectors are equal to the unperturbed Keplerian solution given in 
Eq. (11.32). To match up the velocity vectors, the condition in Eq. (11.21) 
requires that 

Or 

v= —— 11.33 

ot ( ) 
Taking the derivative of the position vector given in Eq. (11.32) and allowing e 
to be time varying, we find that 


dr Se dv de OF 

dt = dedt at 
Making use of Eq. (11.33), we again find the first osculating condition given in 
Eq. (11.24). 


(11.34) 


dr de 


ae (11.35) 
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Taking the derivative of the velocity expression in Eq. (11.32) we find 


dv Ov Ovde 

— = 4 11. 

dt Ot de dt Gee) 
Since 0v/0t is the Keplerian component of the acceleration, comparing Eq. (11.36) 
to Eq. (11.30) we find the second osculating condition in Eq. (11.26) to be 


(11.37) 


de dt | Or 


dv de (2) 3 
We could combine the conditions on the orbit element rate vector é in Eqs. (11.35) 
and (11.37) as is done in Eq. (11.27). However, since the perturbation potential 
Ris often expressed in terms of the orbit elements, the more convenient compact 
form is possible. Following a pattern introduced by Lagrange, we pre-multiply 
Eq. (11.37) by (Or/de)? and pre-multiply Eq. (11.35) by —(0v/de)7 and then 
subtract the latter from the first. After simplifying the algebraic expression we 


find 
ar\" Ov (dv\" dr 
Oe Oe Oe de 
Se 
[L] 


(11.38) 


dt 


de [OROr]’  [aR]" 
Or Oe de 





where [LZ] is a new Lagrangian coefficient matrix. Thus the Lagrangian varia- 
tional equations, which express the orbit element drift é due to the disturbance 


potential R, are written as 
aR]" 
e= ies" se | (11.39) 


The individual entries L;; of this matrix are called the Lagrangian brackets and 
are computed through 


ar \" dv dv\" Or 
Lj; = (es, e;] = 2 2 
- leis e] (=) Oe; (=) Oe; Gt 40) 


Using the state vector s 








_ (rte) 
s(t,e) = Ge (11.41) 
the matrix [L] is written in the compact form 
ds’ 0s 
[Z] = ae ae (11.42) 


where the matrix [.J] is defined as 


[J] = 03x3  Isx3 (11.43) 
—13x3  03x3 
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Since [J] is symplectic, it satisfies the property 
[J][J] = —[exe] (11.44) 


The Lagrangian bracket operator L;; satisfies the the following three prop- 
erties: 


[ei, ej] = —[e;, es] (11.45a) 
lei, e:] =0 (11.45b) 
0 
=, lei, ej] = 0 (11.45c) 


ot 


The latter property is the most amazing truth; the L;; elements are constants 
of the un-perturbed motion. In terms of the Lagrangian matrix [L], these prop- 
erties are summarized as 


[LE]? = -[L] (11.46a) 

—(E])=0 (11.46) 

The skew-symmetry of [I] is immediately verified by studying the definition 
of the Lagrangian bracket operator in Eq. (11.40). To verify that [LZ] never 


explicitly depends on the time variable t, we take the partial derivative of the 
Lagrangian bracket definition with respect to time. 


a a (ar \" (av ar\" a (av 
= lei, ej) = = —|+ — {| —— 
Ot Ot Oe; Oe; 0e; ot Oe; 


T T 
_ 0 (a OTN ae Ne fOr. (11.47) 
ot Oe; Oe; Oe; ot Oe; 


Switching the order of the partial differentiation and making use of the osculat- 
ing condition in Eq. (11.33), we find 


Oconee av)" (dv) | (ar\" a (dv 
aH \ Ge.) Ge; dei) Oe; \ Ot 
dQ (dv\" (dr dv \" ( av 
~ ae (3) (ae) - (Ge) (Ge) 


The first and fourth term clearly cancel each other. To see that the remain- 
ing two terms do cancel, note that the expression O0v/0t is the unperturbed 


acceleration and therefore 
T 
ie (+) (11.49) 




















at Or 
must hold. Using this condition, we are able to reduce Eq. (11.48) to 
0 O OV Or O OV Or OPV OV 


= |e:, €; — — 


iE Gen 0 Onda Oe a 


SECTION 11.2 VARIATION OF PARAMETERS 399 


which proves that the Lagrangian bracket never depends explicitly on the time 
variable. Note that the Lagrangian bracket operator generates information re- 
quired to produce the necessary elements rates é such that the current two-body 
orbit, corresponding to the current elements e(t), osculates or “kisses” the ac- 
tual non-Keplerian orbit. Since [£] does not explicitly depend on time, only 
implicitly through e(t), it does not matter where along the osculating orbit we 
evaluate the bracket expressions. Therefore we will be able to evaluate the La- 
grangian brackets anywhere it is convenient along the instantaneous two-body 
(osculating) orbit. In particular, we will find it convenient later on to evaluate 
the bracket expressions at periapses to reduce the amount of algebra involved. 
This is similar in spirit to the development in Chapter 8 where we chose to 
evaluate the total energy constant a at periapses. 


Example 11.2: Let us examine the motion of vertical spring mass system un- 
der the influence of a constant gravitational field as illustrated in Figure 11.2. 
If the mass m is at a height y, then the spring has zero potential energy. The 
height above ground is measured by the variable y. The velocity of the mass 
is given by v = y. The potential energy of the system is then given by 


k x 
V = mgy + 5(y- 9)" 
The equations of motion are then given by 
pM egy aay 
=~ By aoe 


where g is the local gravitational acceleration and k is the spring stiffness 
coefficient. 





Figure 11.2: Oscillating Point Mass Illustration 


Assume we choose to treat the effect of the spring as a disturbance. Therefore 
we set the mass-less disturbance potential R equal to 
k 2 
R=—(y-Y 
am Yo) 

Without the spring present, the equations of motion of the mass m are easily 
solved to the well-known form 
y(t) = yo + vot — ai? 


u(t) = vo — gt 


400 PERTURBATION METHODS CHAPTER 11 


where yo and vo are the initial position and velocity. For the unperturbed 
problem (i.e. spring-less), these two quantities are the constants of integration 
and do not vary with time. 

We now ask the question, how would we need to vary yo and vo such that 
the perturbed (i.e. spring effect included) problem has the same position and 
velocity expression as the unperturbed problem. Choosing yo and vo to be 
are constants elements of the unperturbed problem, we set 


€1 = Yo e€2 = vo 


To find the desired variation é;, we must first find the various Lagrangian 
brackets. The unperturbed solutions above for y(t) and u(t) provides the 
necessary relationships between the unperturbed position and velocity quan- 
tities and the chosen elements e;. Computing the required partial derivatives 


we find 
Oy Oy 
on Ee 
Ov Ov 
Ga, ey 


Since the skew-symmetric Lagrangian bracket for this problem is only a 2 x 2 
matrix, we only need to compute the one off-diagonal term. 


xen) = 24.20 _ Ov Oy _ 


0e1 Oe2 0e1 Oe2 


The resulting osculating condition on &; (i.e. Yo and to) are 


;,} — | a 
—1 0 e2 Beg 
For a general conservative disturbance potential function R, the variational 
equations for yo and vo are then given by 





: : OR 
eA OO ae 
62 =0 a 
ee aR 


To compute the variational equations for this particular example, we write 
the disturbance potential R as 


= k G42 2 
R= 5_(e1 + eat — 5t — 9%) 


Taking the required partial derivatives with respect to e1 and eg, the varia- 
tional equations for “spring disturbance” are 


: ; k ¥s k 4 
é1 = fo = ——(y-— Ht = -—— (er +eat- 2? —g)t 
m m 2 
; ‘ k a k 2 
é=b0 = —y- 9) == (a1 + eat — £1? ~g) 
m m 2 


These variational equations are readily verified by taking two time derivatives 
of the unperturbed position expression and treating yo and vo now as time 
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varying quantities. The acceleration expression should be the same as is given 
in the exact equations of motion of the system. 


11.2.3. Lagrange’s Planetary Equations 


Given the Lagrangian bracket operator, we now proceed to develop the vari- 
ational equations for a chosen set of orbit elements e. The resulting set of 
first order differential equations is commonly known as Lagrange’s planetary 
equations. We chose the classical orbit element set 


e = (Q,i,w,a,e, Mo)” (11.51) 


as our Keplerian integration constants where Q, i and w are the (3-1-3) Euler 
angle set orientating the orbit plane and line of periapses, a and e are the semi- 
major axis and eccentricity respectively, and Mo is the initial mean anomaly. 
The following development will be analogous for other sets of orbit elements. Let 
n be the mean angular motion defined in Eq. (8.104), then Mo can be expressed 
in terms of the time of periapses passage T as 


Mo = —nt (11.52) 
Kepler’s equation is then given by 
M(t) = Mo +nt =n(t—7T) = E-esnE (11.53) 


To orient the orbit plane and line of periapses, we define the orbit reference 
frame O as 


O: {te,tp, tn} (11.54) 


where 2, points toward periapses, 2), is orbit plane normal and 7, is perpendicular 
to the previous two unit vectors as discussed in Chapter 8. Before evaluating the 
Lagrangian brackets, we first need to find analytical expressions for the inertial 
position and velocity vectors r(t) and v(t) in terms of the chosen orbit element 
vector e. Using Eqs. (8.16) and (8.17) we are able to express the position vector 
r in the orbit frame O as 


* a(cos E — e) 
Of = bsin EB (11.55) 
0 


where b = avV/1 — e is the semi-minor axis. Taking the O frame derivative and 
making use of the F expression in Eq. (8.101), the velocity vector v is expressed 
in the O frame as 


O ; 
—asin FE 


oO n 
= bcosE | —————— 11.56 
x oy 1—ecosE ( ) 
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Let [NO] be the direction cosine matrix that maps orbit frame vector compo- 
nents into inertial frame MN vector components. The position vector r is then 
expressed in inertial components as 


Np = [NO] Or (11.57) 


Note that for the two-body solution the orbit plane orientation is constant and 
therefore [NO] is also constant. The inertial velocity vector v is then simply 
expressed as 


Ny = [NO] Pv (11.58) 


To express the position and velocity vectors in terms of the given orbit elements, 
we parameterize the direction cosine matrix [NO] in terms of the (3-1-3) Euler 
angles 9, i and w as 


cwcD, — sweisQ = —swcD — cwcisQ sisQ 
[NO] = [tetptn] = | cwsQ+ sweic —swsQ+ cwcic —sicR (11.59) 
SWSt CWSI Cl 


where the short-hand notation si = sini and ci = cos? is used again. Thus the 
position and velocity vectors are expressed in terms of Q, i, w, a, e and Mo. 
We note that dependence on the initial mean anomaly Mp is implicit in the 
eccentric anomaly E which must satisfy Kepler’s equation in Eq. (11.53). 

Expressions for r and v in the form given in Eqs. (11.57) and (11.58) will 
be very convenient in the following development. Note that only Cr and °v 
depend on the orbit elements a and e, and implicitly on Mo. Similarly, the 
direction cosine matrix [NO] only depends on the three Euler angles and not on 
the other orbit elements. This separation of dependencies will greatly simplify 
the resulting algebra when computing the various partial derivatives required 
with the Lagrangian brackets. For example, the partial derivative of r with 
respect to 2 is simply given by 


Or 0 

a = INO} @ 11.60 

an anol? ve 
To find the partials of [NO], it is convenient to first find the partials of the orbit 
frame O unit vectors. Expressing the unit vector components as 


te — (4e1, te; tea)? (11.61a) 
ip = (Apis tp2, tps)” (11.61b) 
tn = (ini, th2; tra)” (11.61c) 


we are able to express the various partial derivatives of the O frame unit vectors 
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with respect to the three (3-1-3) Euler angles as 











a. [2 ai,  (— aa, ('” 
— tel —— U1 —S—S 5 thi (11.62) 
0a. 0 0a. 0 on. 0 
is m sisinQ 
ED iy en kei 
— = sinwtp, — = coswipn — = | —cosicosQ (11.63) 
Oi Oi Oi oe 
Ote a 4 a 
ot a ay Lot on =0 (11.64) 
Ww Ww 


As was discussed earlier, since the Lagrangian brackets do not explicitly depend 
on time, we are able to compute the brackets (i.e. the partial derivatives) on 
any convenient location of the osculating orbit. Choosing to evaluate the partial 
derivatives at periapses, at this point we have E = 0 and t = 7. The position 
and velocity vectors in Eqs. (11.55) and (11.56) evaluated at periapses reduce 
to 


oO oO 
q 0 
oO = oO = nab 
Fens, x 0 Ue Suita i qd (11.65) 
0 0 


where g = a(1—e). The partial derivatives of r and v with respect to the (3-1-3) 
Euler angles, evaluated at periapses, are then given by 


Or hea Or 7 Or . 

aq =| ta By = (sinwtn Qu ~ te (11.66) 
0 

Ov tp Ov nabcosw, Ov nab. 

an =q tp Bi = =a th Bis = ae Bk (11.67) 
0 


Since only Pr and °v depend on the semi-major axis a, finding the partial 
derivatives of r and v with respect to a only involves 
OE soe oy jee 
da Oa Oa Oa 
Let us first focus on the position vector partial derivative. Noting that the 
eccentric anomaly E implicitly depends on the orbit elements, we find that 


(11.68) 


Ar 5 cosE —e—asin ES 
Fa = | Vi- sin E+ beos BFE (11.69) 
0 


To express 0E'/0a, we take the partial derivative of Kepler’s equation of Eq. (11.53) 
with respect to a. 
OE OE On 3n 


Aq 7 SHG, Fat 5° (11.70) 
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Making use of Eq. (8.15) we find that 


OE _— 3nt 


ie = oe (11.71) 
Substituting Eq. (11.71) into Eq. (11.69) we express 0°r/da as 
90p cosE —e+asin E+ 
aa V1 —e?sin E — bcos E* (11.72) 


0 


Since the Lagrangian bracket does not explicitly depend on time, we again 
choose to evaluate this partial derivative at periapses where r = q, E = 0 and 
C= ER 





oO 
O°r ga 
Da. — 2q 7 (1 1 .73) 
periapses 0 


Substituting Eq. (11.73) into (11.68) we obtain the required partial derivative 
of the position vector with respect to a. 
Or 3bMo 7 


qd. 
ee 11.74 
Oa a” - 2q te ( ) 


Evaluating the partial derivative of the velocity vector with respect to a follows 
the same logic, but is algebraically more complicated. Using Eq. (11.71), taking 
the partial derivative of the velocity vector v with respect to a we find 


Tr 


e —* sin E+ SoM mt (n cos E+ sin E — anesin® B 
aa: — — cos E+ Babntsin B (1 Je acos?) (11.75) 
Evaluating this partial derivative at periapses we get 
Of 3a2nMo 
ga“ My 


ae) ||) {stn (11.76) 


periapses 0 


0°v 
Oa 





After substituting Eq. (11.76) into Eq. (11.68) we are able to write the partial 
derivative of v with respect to a as 
Ov 3a2nMo bn 
— = -—i. - —1 11.77 
Oa 202" 2q on ( ) 
The partial derivatives of r and v with respect to e and Mo are found in 
a similar manner. By finding the partial derivative of Kepler’s equation with 
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respect to either e or Mo, we find the required partial derivatives of the eccentric 
anomaly FE for any point on the osculating orbit to be 








OE asinE OE a 
eo = 11.78 
Oe r OMo ( ) 
Evaluating these partial derivatives at periapses we find 
OE OE 
€ periapses 0 periapses q 


Using these partial derivatives and following the same path as is used in the 
development of the partial derivatives of r and v with respect to a, we find the 
remaining partial derivatives to be: 





Or : Ov na. 
De = —Atle De = bq tp (11.80) 
Or ab. Ov na? . 
aM = er aMo = Sager (11.81) 


With the various partial derivative of r and v with respect to the orbit 
elements evaluated, finding the Lagrangian brackets now is a relatively straight 
forward matter. We will only carry out the algebra here for the Lagrangian 
bracket [a,w] for illustrative purposes. Using Eq. (11.40), the bracket [a, w] is 
defined as 


[iG] eet et (11.82) 


Using the partial derivative expressions that we have just found, and noting 
that the orbit frame O unit vectors are mutually orthogonal, the bracket [a, w] 
is reduced to 


qd. 3bMo.. nab. 3a?nMo . bn. n 
[a,w] = ate + 3 dy |) - Tage + 397 + 2” ‘Qty 
nb nb 


= —nb —_—_— le 
Bras 5 


Due to the skew-symmetry of the Lagrangian matrix, only 15 distinct brackets 
need to be evaluated and are shown below:! 











[i, Q] = nabsini [w, i] =0 [a,u] =-> [e,a]=0 [Mo,e] =0 
[w,Q] =0 [J=0  [ew]=== [Moa] = > 
[a,Q]=—-cosi —[e,i] = 0 [Mo,w] =0 

[e, Q] = cosi [Mo,i] =0 
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Using these Lagrangian brackets, the osculating constraints on é for a conser- 
vative disturbance potential R are 











0  —nabsini 0 a cosi — nave cosi 0 ” ag 
nab sini 0 0 0 0 0 ae ok 
nb nare cn 8k 

i Y Dee Se epee AAI ae || fost too 

nb . nb na da — 3% 
—+ cost 0 -> 0 0 — : = 
nave : hte e ge 
ac cost 0 7 0 0 0 A 3h 
0 0 0 a 0 0 ni OMo 


(11.83) 


Since many of the Lagrangian brackets are zero, it is relatively easy to invert the 
Lagrangian matrix [L] in Eq. (11.83) and solve for the desired orbit parameter 
rate vector €. For example, due to the sparse nature of [L], solving for Q and 
a is trivial. Solving for the six unknown e;, we obtain the classical form of 
Lagrange’s planetary equations: 





z = can | (11.84a) 
GP aman on eee (11.84b) 
onan rt ede (11.84c) 
a 7 ae (11.844) 
2 
o--Sa (11.84) 
me (11.84f) 


“dt nada ___ nate Oe 
Note that these variational equations, and thus also the corresponding La- 
grangian bracket matrix [L], are singular whenever either the eccentricity is 
0 (ie. circular orbit) or the inclination angle i is zero degrees (i.e. equatorial 
orbit). Further, these differential equations also loose their validity whenever 
the orbit energies rise to the point where the corresponding trajectories are 
parabolic or hyperbolic. The reason for this is the underlying assumption in the 
preceding development that the position vector r(t) is the solution of an elliptic 
orbit. However, by choosing a different set of orbit elements it is possible to 
avoid these singularities. 


Example 11.3: Let us use Lagrange’s planetary equations to compute how 
the J2 gravitational perturbation will affect the orbit elements. The dis- 
turbance potential function R(r) for the Jz oblateness component of the 
spherical gravitational harmonics is defined in Eq. (10.63) and is given by 





R(r) = eu (“)° (3sin? ¢ — 1) 


Qo NER 
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Using Eq. (8.130) we note that 
sing =7%,-t, = sin(w+ f) sini 


This allows us to write the disturbance potential function R in terms of the 
chosen orbit elements as 





2 

R(e) = -3E (=) (3sin?(w + f) sin? i — 1) (11.85) 
PING 

Expressing the orbit radius using Eq. (8.6) and performing the partial deriva- 

tives required in Lagrange’s planetary equations, we find the J2 gravitational 

perturbation to cause the following instantaneous rates in the orbit elements.” 











dQ a? (Teq\?_. 2 : 
ae —3Jane (= sin* 0 cosi (11.86a) 
di Be 0 (Teg \ 2s: saa 
a gears (“2 sin(20) sin(27) (11.86b) 
dw 3 a Teq \? 2 
aE = Te a (=) [cos (21 +e ) 
— ((3 +e”) — (3 + 5e”) cos(2%)) sin? 0) éa860) 
.86¢ 
+ 2e(2 cos(2i) + cos(20) — cos(2(@ — 2)) 
4 2sin?(0 + i))| 
da at Teq 7 : +2 - 2» 
ap sane ( : ) [esin f(1 — 3sin* 6 sin* i) (11,864) 
p. Be SO 
o = sin(26) sin i 
de_ 3 a? /req\2 [Pp . be Den oe aD 
ae zane (=) [? sin f(1 — 3sin* 0 sin“ i) ees 
+ (e + cos f(2 + ecos f) sin(20) sin? i)| 
2 
Moy ae (=) cos f [2 + 6 cos(2i) + 6 cos(20) 
dt 16 °e\r (11.86f) 


— 3cos(2(8 — i)) — 3cos(2(6 + i))| 
Taking the partial derivatives, note that 


Of _ af OE _ ab 


QM, OE AM. 1? 
Also, the true anomaly 0 = w+ f is used here to simplify the rate expressions. 
Note that the orbit elements rates provides in Eq. (11.86) are instantaneous, 
or sometimes also referred to as the osculating, orbit elements rates. In some 
application it is convenient to deal with orbit averaged rates, or also called 
the mean element rates. The J2 perturbation causes three types of rates; 
(1) short period oscillations (2) long period oscillations and (3) secular drift. 
The short and long period oscillations are periodic deviation from the element 
mean values during an orbit. For long term orbit study the secular drift is 
of great interest. Using asymptotic expansion theory, it is possible to extract 
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the secular rates and express the mean or orbit average effect of Jo on the 
orbit elements @ as:° 








] = -S Jan (=) cos i (11.87a) 
: i (11.87b) 
= = Jan (=) (5 cos” i — 1) (11.87c) 
2 ~0 (11.874) 
= -0 (11.87e) 
ae = Bhan (#) J1= 2(3c08" i — 1) (11.878) 


The rigorous derivation of these rates is beyond the scope of this chapter. 
The mapping between mean and osculating orbit elements is found as part 
of Brouwer's artificial satellite theory in Reference 3. Note that there exists 
a critical inclination angle icri¢ = 63.4249 degrees where no mean regression 
of the argument of perigee occurs. 


11.2.4 Poisson Brackets 


The Lagrangian coefficient matrix [L] is written in compact form in Eq. (11.42). 

The Poisson matrix [P] is closely related to the Lagrangian matrix [L]. The 
6 x 6 matrix [P] is defined as 

eee 

— Os° ‘0s 


with s(t,e) being defined in Eq. (11.41) and the symplectic matrix [J] being 
defined in Eq. (11.43). The elements of [P] are called the Poisson bracket and 


defined as 
_ _ Oe; ( Oe; ? Oe; { Oe; z 
Pi; = (ei, ej) = ar ($2) a ($2) (11.89) 


(11.88) 








The Poisson bracket (e;,e;) satisfies the same three conditions as does the La- 
grangian bracket [e;, e,]. 


(e:,e;) = —(e;, e:) (11.90a) 
(ei, e1) =0 (11.90b) 


ay (eis) =0 (11.90c) 
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To find the relationship between [L] and [P], let us evaluate their matrix 
product: 


te) = (2) 11 210 (2) = (22) vy (22) = oe 
Ss 


[Tox] “Rexel 
(11.91) 


Thus the Poisson matrix [P] is the negative inverse of the Lagrangian matrix 
[L]. 


[P] = -[L]~* (11.92) 
Using the skew-symmetry property in Eq. (11.90a), this is also written as 
[P|]? = [z]-? (11.93) 


Recall the Lagrangian variational equations in Eq. (11.39) where the inverse of 
the Lagrangian matrix [L] appeared. Using Eq. (11.93), this equation can now 


be written as 
de aR)" 
— = (P|? |— 11.94 
nr [a8 cam 
Using the Poisson matrix [P] or the Poisson brackets (e;,e;), we are able to 
avoid the matrix inversion of [ZL] when solving for é. After evaluating all the 
Poisson brackets (e;, e;) of [P] for a given orbit element set vector e, Eq. (11.94) 
would lead directly to Lagrange’s planetary equations shown in Eq. (11.84). 

Instead of re-deriving these equations, we will use the Poisson brackets to 
derive the € expressions when the disturbance is provided by a disturbance 
acceleration ag. Substituting the [P] definition in Eq. (11.88) into Eq. (11.94) 
yields 


de Oe AR de\" 
ell sea (11.95) 
After substituting the definitions of s and [J], this is written as 
T P 
Ge FOE OR ae ae (11.96) 
dt Ov |or Or | Ov 


Finally, making use of Eq. (11.31) and the fact that R = R(r), we arrive at the 
compact orbit element rate equation 


de Oe 

a dv" 
Note that no coordinate frame has been chosen yet for the vectors v and aq in 
Eq. (11.97). This equation is very useful in that it holds for all possible frames. 
The following subsections develop the variational equations for several classi- 
cal orbit elements while also maintaining a general vector description without 
choosing a particular coordinate frame. 


(11.97) 
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Variation of the Semi-Major Axis 


To find the semi-major axis rate a due to a disturbance acceleration ag, we 
must first express the semi-major axis in terms of the velocity vector v. To do 
so, we make us of the vis-viva equation: 

2 T 24 


v=vvu=—-— 


r a 


Taking the partial derivative of this equation leads to 


0 2a? 
Steet (11.98) 
Ov [ 

Substituting this 0a/Ov expression into Eq. (11.97) leads to the variation equa- 
tion of the semi-major axis a. 


da Oa Dae 
— = —a,;, = — 11. 
t= Dy tt Z Vv" Gd (11.99) 


Note that Eq. (11.99) holds for any coordinate frame assigned to the vectors v 
and ag. 


Variation of the Eccentricity 


To find the variation of the eccentricity e, the variation of the angular momen- 
tum magnitude h is required. To express h in terms of the velocity vector v, 
we make use of the fundamental definition h = r x v of the angular momentum 
vector. The scalar h is then related to v through 


h? =(rxv)-(r xv) = rut v — (r7v)? (11.100) 
where some standard vector cross product identities were used. Taking the 
partial derivative of Eq. (11.100) leads to 

h 1 

ae (r?v7 — (r7v)r*) Gon) 

Since the partial derivatives of both h and a with respect to v are know 

at this point, it is convenient to solve for the eccentricity variation by using 
Eqs. (8.9) and (8.65). 


h? = wp = pa(1 — e?) (11.102) 
Taking the partial derivative of Eq. (11.102) with respect to v leads to 
Oh Oa Oe 


2h— = p—(1 — e”) — 2uae— ist 
By Ay lh — &) — 2Haen. (11.103) 
Substituting Eqs. (11.99) and (11.101) into Eq. (11.103) leads to 
1 
ee ((pa—r?)v" + (r?v)r*) (11.104) 


ov [uae 
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The variational equation for the eccentricity is then given by 


de _ Oe ay 1 2\.7 T T 
hE Dett= ne ((pa —1r*)v"aqt(r*v)r" aa) (11.105) 


Variation of the Longitude of the Ascending Node and the Inclination Angle 


To find the variations of the longitude of the ascending node (2 and inclination 
angle i, we first define an inertial coordinate frame N : {%,,2,,¢,} and the orbit 
frame O : {tn,%m,%.}. The angles 2 and i are the first two (3-1-3) Euler angles 
which determine the orbit plane orientation. Using Eq. (3.35), the frames O 
and N are then related through 


a cosQ sin 0 ly 
dm p = |—sinQceosi cosQcosi sini] 4 ty (11.106) 
th sinQsini —cosQsini cosi 1, 


The angular momentum vector h can now be expressed in terms of both 2 and 
1 as 
h = ht, = h(sinQsini @, — cosQ sini ty + cost @,) (11.107) 


Taking the partial derivative of h with respect to v, and making use of the 
reference frame unit direction vector identities in Eq. (11.106), we find 


Oh . ., 00 . Ob. Oh 
ae ane i LL (11.108) 


To obtain Oh/Ov, we make use of the fundamental definition of h. 


Oh O(rxv) 
— = SS 11.1 
Ov Ov me) tr 102) 
Substituting Eq. (11.109) into Eq. (11.108) and taking the transpose, we find 
any\* ai \* an\* 
- =hsini{| —) 72 -h( —) #,+(—) @ 11.11 
(rx) sini ($=) a, (=) t+ (2) 27, ( 0) 
By multiplying Eq. (11.110) by 2,, we are able to isolate the 2 derivative. 
0Q. 1. T 
Since the position vector r can be expressed as 
r = r(cos 6%, + sin 4) (11.112) 
where 6 =w-+ f, then the partial derivative of Q is simplified to 
Q in 0 
ey (11.113) 





poe Tt 
Ov hsini ” 
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To find the partial derivative of the inclination angle with respect to v, 
Eq. (11.110) is multiplied by 2,, and r is replaced by the expression in Eq. (11.112). 
Oi rcosO 
—= a 11.114 
Ov h Un ( ) 
Substituting Eqs. (11.113) and (11.114) into Eq. (11.97), the variational equa- 
tions for the longitude of the ascending node and the inclination angle are found 
to be 





dQ On rsin@ 7p 
di dv? hsmi "4 ee) 
di Ou rcos@ wp 
dt = oa i Up, ad (11.116) 








Variation of the Anomalies 


Finding the various anomaly variations is algebraically the most challenging task 
of all the orbit element variations discussed in this section. First, the variation 
of the true anomaly will be derived. This result will then be used to derive the 
variations of the eccentric anomaly E and mean anomaly M. 

The orbit equation in Eq. (8.6) provides an equation which relates the true 
anomaly f to hand e. This is attractive since both the h and e partial derivatives 
with respect to v have already been derived. Taking the partial derivative of 
Eq. (8.6) leads to 

resin fo = reos ae (11.117) 
We could substitute the previously found partial derivative for both e and h at 
this point and attempt to solve for Of /Ov. However, this path involves a lot 
of algebra to reduce the answer to a simple form. Battin presents an elegant 
solution to this problem in Reference 1 which avoids some of the algebra involved 
in reducing the answer. From the position and velocity vector expressions in 
Eggs. (8.132) and (8.133), the following identity is found: 


Tresin f =rly (11.118) 


This equation provides another relationship between the true anomaly f and 
the parameters e and h. Taking the partial derivative of Eq. (11.118) we find 


Peto etapa (11.119) 
v v 
The reason that Reference 1 uses this second equation along with Eq. (11.117) 
is now clear. After multiplying Eq. (11.117) by sin f and Eq. (11.119) by cos f 
and adding the two, the following simplified equation for Of /Ov is found. 


dh - __ dh 
reh=” = poos fr — (p+r)sin fo (11.120) 


SECTION 11.2 VARIATION OF PARAMETERS 413 


Note that the 0e/Ov term has been eliminated by this method and that the 
Of /Ov term is no longer pre-multiplied by sin f. Substituting the partial deriva- 
tive expression for h in Eq. (11.100), the partial derivative of f is expressed as 

Of 1 


x= ma cos f + ee 3 aac (P +") sin fo? (11.121) 





K 


The term « can be further simplified by making use of the orbit equation in 
Eq. (8.6). 


x= Peos f+ (1+ 2) sin’fe 
r Pp 
rere 
= cos f + ecos*f +e+— — —cos’f — ecos”f 
Pp Pp 


ecos f )+ 


~ 1+ecos f Dp 


=e+oos f (1 ; 


=et+ " (cos f +e) 
Pp 





Substituting the simplified « expression back into Eq. (11.121), the reduced 
Of /Ov expression is given by 
O 1 
sea (Ecos f +e) +e) rt — (p+) sin fot (11.122) 
When computing the anomaly rates, we must take into account that the anoma- 
lies do have an unperturbed derivative. Thus 


fof af, 
dt at dv “ 
Ce : (11.123) 
=—+—(-(cosf +e)+e)r7aq— —(pt+r)sin fv? ag 
r2 he \p he 


To find the variation of the of the eccentric anomaly FE, Eqs. (8.3) and (8.16) 
are combined to yield 


cos f +e 


—<§_. 11.124 
1+ ecos f ( ) 


cos E = 
Again, we are able to express the partial derivative of F in terms of already 
derived partial derivatives. Similarly, Eqs. (8.4) and (8.17) are combined to 
yield 


bsin f 


——_——§$—_. 11.12 
a(1+ecos f ( °) 


sin F = 


Taking the partial derive of cos EF yields 


: OE _ . ,Of Oe 
sin B(1 + ecos f) = (ecos B — 1)sin fe +(1 — cos Ecos f) (11.126) 
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After substituting the cos F and sin E expressions in Eqs. (11.124) and (11.125), 
the partial derivative of the eccentric anomaly FE is written as 


OE! OF FO?» OR 


en bbe? weet oe (11.127) 


After substituting the h and e partial derivative expressions and performing the 
typical algebraic reductions, the partial derivative of E with respect to v is 
OE h 
‘ (Ftcos f+ eye” —(r+a) sin fo") (11.128) 
Pp 


dv pbe 


Using Eqs. (8.101) and (11.94), the eccentric anomaly variational equation is 
given by 


dB _ OB | OB 


= + ad 
dt Ot Ov 
tes eae (11.129) 
= —+—(-(cos f+ e)r?aq—(r+a)sin fut ag 
r tube \p 


To derive the variation of the mean anomaly, the mean anomaly definition 
in Eq. (8.103) is used. Taking the partial derivative of M = E — esin FE we find 
OM rdoE Oe 
— = -— - sin E— 11.130 
dv adv. dv ( ) 


After substituting the FE and e partial derivatives and performing several alge- 
braic reductions, 0M/0v is given by 


OM _ rb 
dv hae 
Finally, the mean anomaly variation is given by 
dM OM OM 
eo ge 
dt is : (11.132) 
=n+ hate (cos frvaa— rma + p)sin fo? aa) 


(cos fre = =(r + p)sin fo") (11.131) 


Variation of the Argument of Perigee 


The last variation to be derived is the variation of the argument of perigee. 
This is accomplished indirectly through the latitude argument 6 = w+ f. The 
latitude angle @ is defined as the angle between the unit position vector 2, and 
the ascending node direction 2,. Thus 


cos 6 = 424, (11.133) 
Using Eq. (11.106), this is written as 


cos 6 = cos (42 %,) + sin Q(2) tr) (11.134) 
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When taking the partial derivative of Eq. (11.134), keep in mind that the inertial 
unit vectors 2; and zy, along with the unit position vector 2,, are invariant with 
respect to the velocity vector v. Thus 
4a200 gta se A ORD 
— sind = (—sinQ(@2,) + cos (#) 2,)) a5 (11.135) 
After substituting the unit position vector expression from Eq. (8.130), the 
partial derivative of the latitude angle with respect to v is 


00 —0Q 
— = —cosi— 11.1 
an cosiz (11.136) 
Using 6 =w-+ f, the partial derivative of the argument of perigee w is 
Ow Of OQ 
SS —— 11.1 
Ov dv Oy has) 


After substituting the partial derivatives of f and Q, the argument of perigee 
variation is given by 

di Ow 1 ([r 

> Sia ia (Ecos f+ e) +e) r aa 
rsin@ wp 
htani ne 


(11.138) 





r : 
- Fie P +r)sin ful ag — 


11.2.5 Gauss’ Variational Equations 


The variational equations developed in the previous section are written in a 
coordinate frame independent manner. A very convenient frame used in orbital 
mechanics is the rotating reference frameR = {3,.,%9,%,} where #, is along the 
orbit position vector, 2, is along the orbit momentum vector and %@g is perpen- 
dicular to the previous two satisfying the right-hand rule. This frame is often 
referred to as a Local-Vertical-Local-Horizon (LVLH) reference frame since it 
tracks the local horizon plane (spanned by zg and 2; and the local vertical di- 
rection (ie. @,). Gauss’ variational equations are a specific solution to the 
orbit element variation equation problem where the position vector r, velocity 
vector v and the disturbance acceleration vector aq are expressed in R frame 
components. The position vector is written as 


r=ri, (11.139) 


Since the angular velocity of the R frame relative to the inertial frame N is 
WRIN = Oth = ftn, the velocity vector is expressed as 


r=ri,+rfig (11.140) 


Using the orbit equation in Eq. (8.6) and h = r? f, the orbit radius rate is 
written as 


2 


* = Tyeegs posin sf = Sesin ff = Fesinf (11.141) 
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The tangential velocity component r f is rearranged into the form 


: hh pp 
=a 11.142 
el r hr ( ) 
The velocity vector v is now written as 
vara - (esin fit Xin) (11.143) 
r 


To express the semi-major axis variational equation in terms of LVLH frame 
components of ag, Eqs. (11.139) and (11.143) are substituted into Eq. (11.99) 
to yield 

da: 2a" 
dt oh 

After substituting Eqs. (11.139) and (11.143) into Eq. (11.105), the eccen- 
tricity variation is initially expressed as 


d 1 —r)\(1 3 
ag (sin fa + (pas TJ Recess) Er E5087) ca) 
dt ae ae 


(esin fa, + a) (11.144) 
r 


(11.145) 


After making use of the orbit equation in Eq. (8.6), the eccentricity variation 
expression is reduced to 


= > (psin fa, + ((p+r) cos f + re) a9) (11.146) 


The variational equations for the longitude of the ascending node 2 and the 
inclination angle i are obtained trivially from Eqs. (11.115) and (11.116) since 
iPaq = ah. 

dQ rsin@é 
dt hsini” 
di rcos@ 


= 11.14 
dt Roos oe 


The variation of the argument of perigee w is obtained by substituting Eqs. (11.139) 
and (11.143) into Eq. (11.138) and simplifying 





(11.147) 





dw 1 eee hie zg LA iig rsin 6 cost 

ne ee ee r) sin fag — ————— 
Go he Re : 

The variational equations of the anomalies f, EF and M are obtained by sub- 

stituting Eqs. (11.139) and (11.143) into Eqs. (11.123), (11.129) and (11.132) 


respectively. 


an (11.149) 


hsini 


dp hol 
ae = he. “+ We (p cos far = (p+ r) sin fae) (11.150) 
OE ONE Be ecas ai lee aes (11.151) 
dt r bhe 
b 
aM =n+ — ((pceos f — 2re)a, — (p+1r) sin fag) (11.152) 


“dt ahe 
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Gauss’ variation equations can be very convenient when the disturbance 
acceleration aq is non-conservative. By mapping the acceleration vector into 
the LVLH frame, the orbit element variations can readily be integrated. Also, 
if the disturbance ag is due to a control thrust, Gauss’ variational equations 
show what effect such a control thrust would have on the orbit elements. For 
example, studying the variational equations of the ascending node 2 and 2, it 
is clear the most efficient period during an orbit to make a nodal correction is 
during the polar crossing where sin @ is maximized. Similarly, the most efficient 
period to adjust the orbit inclination is during the equator crossing where cos 
is maximized. Since these equations are so convenient, they are summarized 
below one more time. 


da 2a? 








<== (csin fay a a) (11.153a) 
Ce = = (psin fay + ((p +1) cos f +e) a9) (11.153b) 
c= rest (11.153c) 
= = rene ay (11.1534) 
“ = — 7 00s far + = (p+r)sin fag — RECS! (11.153e) 
ae =nt+ ie ((pcos f — 2re)a, — (p +r) sin fag) (11.153f) 


11.3. State Transition and Sensitivity Matrix 


A state transition matrix [®(t,to)| provides a direct mapping from initial con- 
ditions r(to) to the final state vector r(t) at any particular time. This matrix 
can be viewed as the sensitivity matrix of the current state to the initial con- 
ditions. As such, it has many applications in perturbation theory since it can 
show, if setup properly, how initial trajectory errors will evolve over time. The 
state transition matrix, along with the associated sensitivity matrices, are also 
commonly used in control theory to drive initial trajectory errors to zero. This 
section presents basic the state transition matrix theory for both linear and 
nonlinear dynamical systems. Finally, an analytical solution is developed for 
the special case of Keplerian motion. 
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11.3.1 Linear Dynamic Systems 
Homogeneous System 


Let us begin by consideration of the homogeneous (constant coefficients) vector- 
matrix differential equation case 


ane & = [Alx x(to) = ao, [A] = constant (11.154) 
where a(t) is a n-dimensional state vector. To establish the form of the general 
solution, we look at a Taylor’s series solution. 


“ @a| (t—to)” 

t)= a(t —_| —— 11.155 

v(t) = alto) + > el, a (11.155) 

By differentiating Eq. (11.154) and enforcing [A] to be a constant matrix, note 
that the higher order derivatives of a(t) are expressed as 


d” x(t) 
dt” 





= A" x(to) (11.156) 


Substituting Eq. (11.156) into the infinite series in Eq. (11.155) yields 


~ t—49)” 
a(t) = (a +> ur) a(to) (11.157) 
n=1 . 
Matrix Exponential 


Note that the expression between the large brackets is precisely the definition of 
the matrix exponential function. Thus we are able to write the general solution 
for a(t) in the compact form 


a(t) = elAl@—*to) 2 (t9) (11.158) 


Compare this solution to the solution of the scalar linear homogeneous equa- 
tion 


£= ax (11.159) 
which has the well-known solution 
eG) =e a, (11.160) 


Thus, except for the order of the matrix multiplication, the solution of Eq. (11.158) 
is analogous in many ways to the solution of the scalar case. However, caution 
must be exercised with this analogy since it isn’t perfect. 

Continuing with the constant [A] case, let us now introduce a classical result 
which, if [A] has distinct eigenvalues, transforms the computation of the matrix 
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exponential e[4](*-to) into a trivial exercise. Consider the transformation to a 
new n-dimensional state vector 7. 


x(t) = [T]n(t) (11.161) 


where [7] is a constant, non-singular n x n matrix. Substituting the definition 
of a(t) into the state differential equations in Eq. (11.154) yields 


9 = (IZ)"TAIT)) 0 (11.162) 


The question now is how should the constant matrix [T] be chosen such that the 
matrix matrix multiplication [A] = [T]~1[A][T] becomes diagonal? The answer 
is to chose the columns of the [T] matrix to be the eigenvectors of [A]. To prove 
this, we write out the matrix multiplication as 


TT) ITI==]. (11.163) 
0 0 Xe 
which leads to 
[A] [7] = [T][A] (11.164) 


Defining t; to be the 7-th column matrix of [T], Eq. (11.164) is rewritten as a 
series of n equations. 


From Eq. (11.165) it is obvious that the matrix diagonal entries \; are the 
eigenvalues of [A] and the columns ft; are the corresponding eigenvectors of 


[A]. Thus this state transformation transforms the originally coupled set of n 
differential equations into n uncoupled differential equations. 


n(t) = Ain(t) (11.166) 


Using the classical solution of a linear differential equation with constant coef- 
ficient in Eq. (11.160), the state vector n(t) is computed as 


e>1(t-to) 0 bie 0 
0 er2(t—-to) ... 0 
n(t) = : : n(to) (11.167) 
0 0 era(t—to) 


with a matrix exponential expression which is trivial to compute. Substituting 
the state transformation definition in Eq. (11.161) back into the 7(t) solution 
and equating it with the a(t) solution in Eq. (11.158), we are able to compute 
the complex matrix exponential el4](—‘o) through 


elAl(t—to) — (T] [diag(e*¢-*e))| ae (11.168) 
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Non-Homogeneous System 


Now, having covered the solution to a homogeneous set of differential equations, 
we consider the more general case of non-homogeneous differential equations 
where the matrix [A(t)] is time varying. 


a(t) = [A(t)]x(t) (11.169) 


Going back to the analogy with the scalar case « = a(t)a(t) which has the 
solution 


x(t) = a(to)eloa(r)dr (11.170) 
we might expect that the solution of Eq. (11.169) be of the form 
w(t) = efolA M4 9 (49) (11.171) 


But Eq. (11.171) does not hold in general. It only holds for the special cases 
where either 1) [A] is constant, 2) [A] is diagonal and more generally 3) if 
[A] [[A]dr = [[A]d7[A]. Instead, in order to solve the set non-homogeneous 
differential equation & = [A(t)]a, we seek a linear operator [®(t,to)] which 
maps the initial state vector ao into a(t) as in 


x(t) = [®(t, to)|x(to) [®(to, to)] = Unxn] (11.172) 


This linear operator [®(t,to)] will be referred to as the state transition ma- 
triz. Substituting the proposed solution of a(t) in Eq. (11.172) back into the 
differential equation in Eq. (11.169) yields 


([8(¢, to)] - [AJC to)]) ato) = 0 (11.173) 


Since Eq. (11.173) must hold for any initial condition xo, it is apparent that the 
state transition matrix differential equation must satisfy 


[®(t, to)| = [AMI[P(, to) [®(t, to)| = Unxn] (11.174) 


Thus, in the worst case we can solve Eq. (11.174) numerically to determine 
[®(t, to)]. Also, notice from Eq. (11.172) that the state transition matrix can be 
defined as 


[®(t, to)] = so (11.175) 


Thus [®(t, to)] can be viewed as the sensitivity of the current state vector a(t) 
to the initial conditions x(to). 

For the special case where [A] is a constant matrix, we take the partial 
derivative of Eq. (11.158) with respect to ao to find the state transition matrix 
for the homogeneous linear system. 

Ox(t) 


[B(t, to)| = a = ¢lAl(tto) (11.176) 
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To verify that this is indeed correct, the state transition matrix [®(t,to)] is 
expanded as a Taylor’s series. 


O(t, to)] (t — to)” 
[®(t, to)] = [®(to, to) (eo 49) + Se ot 0) == (11.177) 


ie 


Since [A] is a constant matrix for this special case, the higher derivatives of the 

state transition matrix are given by 
d”|®(t,t 
PUP toll _ Lape, to) (11.178) 


Substituting these higher derivatives back into Eq. (11.177) yields the expected 
definition of a state transition matrix for a linear homogeneous system. 


athe to) 
[B(t, to)| = UInxn] + dia (= to)” _ eLal(e-to) (11.179) 





Matrix Exponential 


In general, note that the state transition matrix [®(t,,t;)] maps the state 
vector at time ¢; to a state vector at time t;. 


Thus, given the three times t,, t2 and t3, we are able to write 


x(t3) = [®(t3, ta) |a(to) (11.182) 
x(t3) = [®(ts, t1)|a(t1) = [G(ts, t2)][®(ta, t1)]a(t1) (11.183) 


We conclude that [®(t;,t;)] abides by the group property 
[P (te, ta)] = [O(te, ty )[O(t;, ta) (11.184) 
Also, note that the inverse of the state transition matrix is simply defined as 
[B(t;, ta)}-* = [B(ti, ty) (11.185) 
Next, let us consider a linear differential equation with a forcing term u(t). 
xz = [A(t)]a(t) + [B(t)]u(t) (11.186) 
For the special case where u(t) = 0, we have already established that 


x(t) = [®(t, to)|x(to) (11.187a) 
[®(t, to)] = [A(d)][®(¢, to)] [®(to, to)] = Unxn] (11.187b) 
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For u(t) # 0, we seek to replace a(to) by a function of time C(t) to make 
Eq. (11.186) satisfy the forced differential equation in Eq. (11.186). Employing 
Lagrange’s method of variation of parameters, we seek to find out what C(t) 
will make the solution of Eq. (11.186) have the the form 


a(t) = [®(t, to) |]C(t) C(to) = xo (11.188) 


Differentiating Eq. (11.188) and making use of Eq. (11.187b) yields 


w(t) = [AM][B(E, to |C]® + [B(E, to] CM (11.189) 
Substituting Eq. (11.187a) into Eq. (11.186) and comparing the resulting « 
expression to Eq. (11.189), the differential equation for C(t) must satisfy 


C(t) = [®(¢, to) [BO] u(t) (11.190) 


Integrating C while making use of C(to) = ao and the state transition matrix 
inverse property in Eq. (11.185), the function C(t) is now expressed as 


C(t) = atta) + f [®(to, T)|[B(7)]u(r)dr (11.191) 


Substituting this C(t) function definition back into Eq. (11.188), the state vector 
x(t) is expressed as a function of the initial conditions and the forcing function 
u(t) as 


a(t) = [®(t, to)|a(to) +f [®(t, r)][B(7)]u(r)dr (11.192) 


to 


11.3.2 Nonlinear Dynamic Systems 


While the linear systems theory allows us to predict the response of a large class 
of systems, often the dynamical systems of interest are nonlinear in their nature. 
For example, the prime differential equation of interest for Keplerian two-body 
motion is # = —p/r?r which is nonlinear. In the following development we will 
illustrate how it is still possible to describe time evolution of a state vector in 
terms of a state transition matrix. 

Let us consider the case of a forced nonlinear dynamical system of the form 


a(t) = f(t,a(t),p,ult)) ——-@(to) = wo (11.193) 


where the n-dimensional vector p is a force model parameter vector. It contains 
time invariant parameters which affect the effectiveness of the control vector 
uw such as the moment arm for example. Integrating this differential equation 
yields 


x(t) = x(to) +f f(r, x(7), p, u(7))dr (11.194) 
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We are interested in the sensitivities of the current state vector a(t) with respect 
to either the initial state vector a(t ) or the force model parameter vector p. 





[P(t to)] = a (11.195) 
[W(t, to)] = = (11.196) 


The sensitivity matrix [W(t,to)] could be useful in determining how to modify 
the p vector to enhance the a(t) trajectory. Differentiating Eqs. (11.195) and 
(11.196) gives 


[®(¢, to)] = Unxn] + [ se ae dr (11.197) 


[W(t, to)] = [Onxn] + E (eS Be a 0) dr (11.198) 


where f() = f(7,x(T), p, u(T)) is implied. Let us introduce the following defi- 
nitions for this nonlinear system. 




















awl |o (11.199) 
[c(t)] = | (11.200) 


Differentiating Eqs. (11.197) and (11.198) with respect to time leads to the 
following sensitivity matrix time rates: 


(6 (2, to)] = [AOI to)] | [®(to,to)] = [nxn] (11.201) 
(b(t, to)] = [ADIGE to)] (CM) —-, [Wlto,to)] = [Onxn] (11.202) 

If it is necessary to compute the solution of «(t) = f(t, x(t), p, u(t)) numeri- 
cally, then it is generally also impossible to solve analytically for either [®(E, to)] 
or [W(t,to)]. One standard algorithm is to simply integrate the three differen- 
tial equations provided in Eqs. (11.193), (11.201) and (11.202) simultaneously. 
Now, if the differential equation in Eq. (11.193) can be solved analytically for 
a(t), then it is usually not necessary to directly solve the differential equations 
of [®(t, to)] and [W(¢, to)]. Rather, we can simply determine these sensitivities 
by partial differentiation of the analytical solution a(t). 

Eqs. (11.201) and (11.202) define the state transition matrix and force pa- 
rameter p sensitivity matrix for the actual trajectory x(t) of a nonlinear system. 
However, occasionally it is convenient to study the evolution of deviations da(t) 
from a reference trajectory x,e(t). This trajectory is generated using a refer- 
ence initial condition a, ¢(to), along with a reference control vector u,e f(t) and 
reference force model parameter pyer. We formally indicate this trajectory as 


t 
Lref(t) = Lrep(to) +f f (7, rep (7), Pref, Ures(T)) aT (11.203) 
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Let the actual trajectory be provided by the nonlinear equation in Eq. (11.194). 
Deviations of this trajectory to the reference trajectory are then defined as 


5x(t) = a(t) — tres (t) (11.204) 


Using a first order Taylor series expansion of Eq. (11.194) yields 


x(t) ~ x(to) +f (f(t, Lref(T), Pref, Ures (t)) 


to 
+ S| ba + Ea du + oe dp )dr (11.205) 
Ox ref u ref Op ref 
Defining the following partial derivative short hand notations 
of() 
[A(t)] = Ea (11.206) 
Ox Bey 
_ [9f0 
[B(t)] = [So (11.207) 
Ou ey 
_ 
Cc(t)) = |-—— : 
cw) = | Ly (11.208) 
the trajectory deviations da(t) are approximated as 
t 
ba(t) = da(to) +f ([A(r)]oa + [B(7r)]ou + (C(r)]6p) dt (11.209) 
to 


Note that the da(t) derivative is now given by the linear, time dependent dif- 
ferential equation 


5a(t) = [A(t)]oa + [B(t)]ou + [C(t)]dp (11.210) 


Since Eq. (11.210) is of the form assumed in Eq. (11.186), we can write the 
solution to this differential equation in terms of the state transition matrix as 


5a(t) = [®(t, to)}da(to) + if [®(,7)] ([B(r)]ou + [C(r)]6p) ar (11.211) 


to 


Differentiating Eq. (11.209) with respect to dxa(to), the state transition matrix 
is defined for the departure motion as 


[B(t, to)] = ae = [Inxn] +f [A(z7)] a dr (11.212) 


to 


Thus the state transition matrix assumes the now familiar form 


[(¢, to)] = [AWIIBE, t0)], [®(to, to)} = nxn (11.213) 


SECTION 11.3. STATE TRANSITION AND SENSITIVITY MATRIX 425 


The sensitivity matrix [V(t,to)] of the trajectory deviations with respect to the 
force model parameter vector differences dp is given by 


(W(t, to)] = ee = [Onin] + ff (ACG, t0)] + [CC))Ar_ (41.214 


The differential equation of [V(t,to)] again assumes the form 


(W(t, to)] = [AGE to] +1C@], — [WE to)] = [Onxn] (11.215) 


11.3.3 Symplectic State Transition Matrix 


Discussing the direction cosine matrices in Chapter 3 we found that they had 
the wonderful property of being orthogonal. Thus, their inverse is simply the 
transpose of the matrix. If the state transition matrix satisfies some specific 
properties, we can show that it is symplectic. This means that it too will have 
a simple analytic matrix inverse formula. Let [®] and [J] be a 2n x 2n matrices 
with [J] being defined as the skew-symmetric matrix 


[J] = ee oe (11.216) 


Inxn Onxn 


Note that [J]? = [J][J] = —[Ienx2n]. The matrix [®] is called symplectic if it 
satisfies the following condition: 


[®]* [][@] = [J] (11.217) 


The significance of this condition is that if we pre-multiply it by [J] and post- 
multiply it by [6]~', then the matrix inverse of [®] is given by 


[®)-* = -[J][e]* [7] (11.218) 


Partitioning the matrix [®] into n x n submatrices ®,; through 


®1, Py 
©) = 11.219 
[®] Be | ( ) 


the matrix inverse of [®] is expressed analytically through the simple expression 


Go  Le@p 
Pre of (11.220) 


g|-!= | 
lag eee 


The following development will show necessary conditions which will guar- 
antee that the state transition matrix [®(t, to)] is symplectic. Let the dynamical 
system be given through the second order differential equation 


F=b=f(t,r) (11.221) 
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where r is a n-dimensional state vector and v = r. Let the 2n dimensional state 


vector x be defined as 
r 
r= (*) (11.222) 


Then the second order differential equation in Eq. (11.221) can be written in 
first order form analogous to Eq. (11.193) as 


& = F(t,x) = Ge -) (11.223) 


Using Eq. (11.199), the linear state plant matrix [A(t)] is given by 


[A(t)] = “ae a zs oe a (11.224) 
The n x n matrix [G] is defined here as 
[G] = ares | (11.225) 


Using the results from Eq. (11.201), the state transition matrix for the dynamical 
system defined in Eq. (11.223) must satisfy 


[&(t,to)] = [ACE t0)}, ——-[B(to, to)] = [anx2n] (11.226) 


The question now is, under what conditions will this state transition matrix 
satisfy the symplectic condition shown in Eq. (11.217). By inspection, it is clear 
that this condition is satisfied at to by the [®(to, to)| given in Eq. (11.226). To 
complete the proof that [®(t, to)] is symplectic, we must next show that 


£ (((¢,t0)]” [Z] [Ct t0))) = [Danza (11.227) 


Substituting the [®(t,to)] definition in Eq. (11.226), we find that 


[®(¢, to)]* L(t, to)] + [(E, to)" [JU&(, to)] 
= [®(¢, to) [AO] * [I[G(E, to)] + [G(, to) ) AMI G(E, to) 
= [®(t,to)]? ((A®]*1] + (IA) [®(, to)] Lls228) 


= [®(¢,to)]7 Pe oe 





| [®(t, to)] = (Oonx2n] 


Thus, the only condition necessary for the state transition matrix [®(t, to)] of 
the dynamical system given in Eq.(11.223) to be symplectic is that [G] = [G]" 
is symmetric. 


SECTION 11.3. STATE TRANSITION AND SENSITIVITY MATRIX 427 


Example 11.4: Again, let us return to our favorite differential equation 
describing Keplerian two-body motion. 


j= —4r =-VV(r) 


This second order differential equation of of the form assumed in Eq. (11.221). 
Let r = r(x,y,z), then the matrix [G] is expressed as 


a2v. o?V. a2V 











xc co LOZ 

i= [eerie] ce A ees ee ee 
= 0x0: 2 OyOz 

or av. sy aev 








OxO0z OyOz Oy? 


Since [G] = [G]", the state transition matrix of the Keplerian 2-body problem 
is guaranteed to be symplectic and posses the elegant matrix inverse shown in 
Eq. (11.220). More generally, the symplectic [®(t, to)] property is a property 
of conservative systems and “natural” coordinates. 


11.3.4 State Transition Matrix of Keplerian Motion 


Since there exists an analytical solution to the two-body problem, it is also 
possible to develop an analytical solution to the state transition matrix of the 
two-body problem. Using the F' and G solution developed in section 8.4.3, 
we are able to express the position vector r(t) and velocity vector v(t) as a 
nonlinear function of time and the initial conditions rp = r(to) and vo = v(to). 


eh Co a E | ne | is (11.229) 


The scalar F' and G coefficients, along with their derivatives, are given by 


a? 





Pot coeh) G=At+,/—(sin£ - B) (11.230) 
TO LM 

fr NES a G=1+4 "(cos #1) (11.231) 
TTO r 


with At = t—to and E = E— Ep. The state transition matrix [®(t, to)| for this 
nonlinear system is defined as 


[P(t to)] = le =| = = (11.232) 


At first glance, it might appear that [®(¢,to)] would simply be given by 


Fe I3y3 G+ I3x3 
[B(t,to)] ee ad 
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for the two-body problem. However, this conclusion neglects the fact that the 
F and G functions themselves also depend on the initial state vector. Only for 
linear dynamical systems does the state transition matrix map directly between 
the initial and current state vector. For a nonlinear system, the state transition 
matrix provides the sensitivity matrix of the current state vector with respect 
to the initial condition vector. Thus, to find the state transition matrix for 
Keplerian motion, we must find the various partial derivatives of the F and G 
functions with respect to the initial state vectors. 

Subdividing the 6 x 6 state transition matrix into four 3 x 3 matrices ®;;, and 
using the F' and G solution to compute the required partial derivatives leads to 
the following result: 


dr(t) OF aG 




















Oy = = Flix tro + Ma (11.233a) 
oe ua Ge Teac roa Be wa (11.233b) 
bo “ =P Igy3 + moe de woe (11.233c) 
Oy = wee Evie moe st mo (11.233d) 


Before we tackle the complex partial derivatives of F and G, along with 
their derivative functions, we develop the partial derivatives of various scalar 
parameters. The partial derivatives of the initial orbit radius rg and initial orbit 
velocity magnitude vo are given by 


Oro 1 pp Oro Tr 

= —=0 11.234 
Oro TO "0 Ovo ( ) 
Ovo T Ovo 1 T 
—=0 —_— =— 11.2 
Oro Ovo VO 0 ( 2) 


Using the definition of 09 = (1/,/f)r§ vo, the partial derivative of oo with 
respect to either ro or vg is given by 
O00 1 Ooo 1 oo 
— = —v — > Tr 11.236 
Oro Ji 0 Ov ts 0 ( ) 
To find the sensitivities of the semi-major axis a with respect to the initial state 
vectors, we write the vis-viva equation (Eq. (8.77)) at the initial time to as 
1 2 2 
See (11.237) 
a 70 LM 
To simplify the development of the various partial derivatives, we introduce the 
place-holder vector a. This vector can be either rg or vg. Taking the partial 
derivative of Eq. (11.237) with respect to the generic @ vector yields 
1 Oa 2 Oro 20 Ovo 


Beg ee ee 1.2 
a? Oa 73 0a = Oa neeess) 
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Substituting Eqs. (11.234) and (11.235), the partial derivatives of a with respect 
to either rp or Vo are 


da 2a? op Oa 2a op 
Oro = reo Ovo = ra (11.239) 


To find the sensitivity of E with respect to the initial state vectors, we make 
use of the modified Kepler’s equations derived for the F and G solution in 
Eq. (8.176). 


Sat= b+ (2B-1)sine+ (1 cosh) (11.240) 


Taking the partial derivative of Eq. (11.240) with respect to the generic vector 
a, we find 


3 / pu Oa _ TO A oo. @ OB 
ae SAIS (1+ (2-1) c+ “sin £) aa 


1 Oro To . 1 00 _- Oa 
+ (- sin né) at (~3sin B - salt - 00s B)) Ba 
Ooo 


+ : (1 B= 
—= cos B) 


Ti 


Substituting the orbit radius expression in Eq. (8.172) and solving for the partial 
derivative of EF, we find 


ie Oa 
aa == (-3/4 ae sar (1 0os £)) 
— ate V8 — cs 8) S20 (11.242) 


(11.241) 








To find the sensitivity of the orbit radius r at time t, we make use of the orbit 
radius expression in terms of the eccentric anomaly difference EF in Eq. (8.172). 


r=a(1+ (2-1) cos E+ “sin £) (11.243) 
a 


Taking the partial derivative of r with respect to the generic vector a@ yields 


Or Be, DG) oN OG =, O19 
on (1 cos B+ 5 ThsinB) + Ba cos Ea— 


0 OB 
Vasin B= +a ((1 = =) sin B + “cos B) SE Se (11244) 
At this point we are able to compute the partial derivatives of the scalar 
functions F' and G, along with the derivatives of the associate derivative func- 
tions, using the intermediate results we just derived. Using Eqs. (11.230) and 
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(11.231), the sensitivities of the F, G, F and G scalar parameters 
state vectors are expressed as: 


OF 1 Fe Oa sa OF as AOR, 
aa a — cos E) (-3+ <x) - on oe 


0G _ 3 fa,. » Oa fai = OB 
5a 5y gene laa Go a 





OF  _sinE f 1 0a  10r9 1 0r OE 
da Vr, (a3 1m 1 co BE] 
aG 1 «(0a «aor a. ~0E 
Ba = ptt 008 #) (Se - S52) - Ssin oe 
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to the initial 


(11.245a) 


(11.245b) 


(11.245c) 


(11.245d) 


As was the convention earlier, the vector a in Eq. (11.245) is replaced with either 
ro Or Uo. Substituting the partial derivatives in Eq. (11.245) into Eq. (11.233), 
an analytical solution to the two-body problem state transition matrix is found. 

While the presented analytical method to compute the state transition ma- 
trix is relatively straight forward to program, it is not a very compact or elegant 
solution. Richard Battin develops in Reference 1 an elegant and compact analyt- 
ical expression of the two-body state transition matrix by performing extensive 


algebraic simplifications. Defining the scalar parameter C' as 


3 : se ‘ 
C=a/— (3sin B - (2 + cos £) P) — Ata(1 — cos £) 
[ 


and the position and velocity vector differences as 
6r=r—To dv = v— Vo 
he is able to express the state transition submatrices ®;; through 
r 1 
D1 = oveee + m2 (rod = F)rrg + Cour9 ) +F. 1343 
0 


C 
Dio = me i F) (6rug = dur ) + wee +G.- 1343 


: 1 1 
+F (i: _ srr? + —=(rv? — or" bo") 
r ur 
1 ; 
@oo =  o060" + 3 (ro(1 _ F)rrg _ Crvg ) +G- 5x3 


with the state transition matrix being defined through 


Sm O11 D2] _ a ae 
[ ]= ® ® —~ | Or or 
21 22 oro Oro 


(11.246) 


(11.247) 


(11.248a) 


(11.248b) 


(11.248c) 


(11.248d) 


(11.249) 
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Problems 


11.1. Observe that the F and G solution in Eqs. (8.148) and (8.149), using rectangular 
coordinates, can be written in the form: 


(11.250) 


| 
oGOoOyCOy 
omyooyo 
moomoo 
oonC ON 
oMCoogROS 
Rc ODQCO 


NC BRL Y 


_ 
[O(¢,to)] 


Comparing Eq. (11.250) with the usual state transition matrix form, we conclude 
that [O(t, to)] “looks like” a state transition matrix [®(¢,to)] in that it maps 
initial conditions into the instantaneous state. But [®(t, to)], as we developed in 
this chapter, approximately maps the linearized departure motion in the sense 


Ox 6x0 
oy dYo 
Oz - 620 
oy dYo 
6z 620 


Note that [®(£, to)] is fully populated, whereas [O(t,to)] has an elegant sparse 
structure. Establish the relationship between these two matrices. 


11.2 Program the state transition matrix computation of the two-body problem using 
Battin’s method in Eqs. (11.246)—(11.249). 
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CHAPTER TWELVE 


Transfer Orbits 





LANET is latin for ” wanderer.” As seen by an Earth based observer, the 

planets appear to wander across the sky on smooth, but seemingly arbi- 
trary paths. Aristarchus of Samos (310-230 B.C.) was a Greek astronomer and 
mathematician who developed a heliocentric universe in which the Earth ro- 
tated about the Sun. He even developed an ingenious geometric method to 
determine the distance between the Sun, Earth and the moon. However, this 
knowledge got mostly forgotten during the afterward until Nicholas Copernicus 
(1473-1543 A.D.) rediscovered the fact that the Earth rotated about the Sun. 
Galileo Galilei (1564-1642 A.D.) later confirmed through the use of his tele- 
scope that the Earth revolved about the Sun. Understanding this was crucial 
to understand the orbits of the planets. Since the planets each have a different 
mean heliocentric orbit radius, they travel each at different rates. As seen from 
the rotating Earth frame, observing the planet’s trajectories yields interesting 
and complex geometric paths. 


At first glance it would appear very daunting to attempt to travel between 
planets with their relative trajectories being so complex. Of course, choosing an 
inertial Sun centered reference frame is the first step toward simplification of the 
interplanetary motion. Similar considerations govern transfers between Earth 
centered orbits. This chapter discusses some basic methods used to design 
interplanetary transfer orbits. Various methods of minimum energy transfer 
orbits are discussed, as well as the two-point two-body boundary value problem. 
The method of pathed-conic’s is a convenient method to perform preliminary 
mission analysis. Here the total transfer orbit from one body to another is 
broken up into various stages where there is only one dominating gravitational 
influence. The section on patched-conic orbits will discuss issues in developing 
the interplanetary transfer orbit, as well as issues in designing orbits to escape 
and enter a planet’s sphere of influence. While most theory is typically applied 
to travel among different solar system planets, it can also be applied to travel 
between other celestial bodies such as moons or comets. 
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12.1 Minimum Energy Orbit 


Often it is of interest to find a suitable transfer orbit that will connect two points 
in space. The following development will derive the concept of a minimum 
energy transfer orbit. As discussed by Battin in Reference 1, this minimum 
energy orbit becomes a good initial guess at an orbit to start the numerical 
iteration to find the solution to the two-point boundary value problem. It is 
also convenient to find other specialized orbit transfers such as the Hohmann 
transfer. 





Figure 12.1: Illustration of Lambert’s Problem 


Consider the general elliptical orbit that connect points P, and P2 shown 
in Figure 12.1. Let r; and rg be the corresponding position vectors relative 
to the occupied focus F’, and let rj and rz be the position vectors relative to 
the un-occupied focus F*. We begin the development of the minimum energy 
transfer orbit by recalling a key geometrical property of an ellipse. The sum 
of the two radial distances from any point on the ellipse to each focal point is 
constant and equal to 2a. Thus, we are able to write 





FP, +F*P, = 2a (12.1a) 
Bw Na 

TL rt 
FP, + F*P, = 2a (12.1b) 
Bw RS 

r2 TZ 


where the notation r; = |r| is used. Summing Eqs. (12.la) and (12.1b) we 
obtain the following geometric result which must hold for any ellipse: 


ri tretry, +r = 4a (12.2) 
S— 


fixed 
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Since the radial distances r; and rz are specified by the two-point boundary 
value problem statement, we are only free to chose the parameters rj, r> and 
a. Note that the radial distances rj to the un-occupied focus are related to the 
chord length c through the inequality constraint 


e<ritrs (12.3) 


Recall the elliptic orbit energy equation, also referred to the vis-viva equation, 
given in Eq. (8.77) through 


ee aa ae gee (12.4) 

2 r 2a 
where £ is the total orbit energy and v = |r|. Studying Eq. (12.4) it is clear that 
in order to minimize EF, we seek a transfer orbit with the smallest semi-major 
axis parameter a. Revisiting the elliptic orbit condition in Eq. (12.2), minimizing 
a means that the sum rj + rj must be minimized. However, according to the 
constraint in Eq. (12.3), the smallest possible value that the sum rj + r3 can 
achieve is the chord length c. Thus we conclude that the un-occupied focus of the 
minimum energy transfer orbit must lie on the chord vector c. The semi-major 
axis Gm of this minimum energy orbit is then given by! 


1 
dm =F (ri tre +c) (12.5) 


Notice that (r1 + r2+c) is the perimeter of the triangle F'P;P:. Given the 
initial and final position vectors r; and rz, we can compute c using 


c= |r = r}| (12.6) 


If we know the true anomaly difference Af between the points P; and P2, then 
we can use the law of cosines to compute c through the scalar values r; and r2. 


c= 1/73 +r? — 2rirecos 6 (12:7) 


Example 12.1: Let us consider the special minimal energy orbit transfer 
case where r} = re = r as illustrated in Figure 12.2. Note that this problem 
is essentially the minimal energy ballistic missile problem which was discussed 
in Example 8.3. Therefore we can assume that we are attempting to fire a 
projectile at time ¢; and target a point on Earth’s surface that is Af degrees 
away. For this special case where the initial and final orbit radius are equal 
(the Earth is assumed to be spherical here), the cord length determined using 
Eq. (12.7) to be 


c=rvV/2(1—cos Af) 


Using the energy equation, the normalized initial velocity magnitude vo is 
given by 


2 B 
UO — 


min 
am 
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Figure 12.2: Illustration of Lambert’s Problem with the r1 = rg Con- 
straint 


where the velocity magnitude is normalized by \/j/r. Since 1/am is given 
by 

1 864 

Gm rte 





the minimum energy transfer orbit initial velocity vo is expressed in terms of 
the range angle Af as 


ve ie ee 
cite 2+ \/2(1 — cosAf) 


Note the two simple special cases where Af is either 0 or 180 degrees. For 
the case where Af = 0 degrees, we find that vo is equal to zero. This makes 
intuitive sense since it should take no energy for an object to remain at the 
same location. If Af = 180 degrees, then the normalized vo becomes 1. 
This corresponds to the projective being in a circular orbit and just skimming 
across the surface. 

The minimum velocity function developed in the Example 8.3 is expressed in 
terms of the semi-range angle ¢ = Af/2. 


2 2 1 
ap = 2t —-l 
Bam = 2006 (Tey —1) 
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After performing some extensive trigonometric algebra, it can be shown that 
the two velocity expressions are identical. 


12.2 The Hohmann Transfer Orbit 


Let us consider the special transfer orbit case where the Af is equal to 180 
degrees. The minimum energy transfer case is illustrated in Figure 12.3. Note 
that since the un-occupied focus F’* must lie on the cord c, the points P; and 
P, become either the apoapses or periapses of the transfer orbit, depending on 
which r; is larger. This type of minimum energy transfer orbit is commonly re- 
ferred to as a Hohmann transfer orbit.?* ? Walter Hohmann (1880-1945) showed 
in 1925 that an elliptic transfer orbit requires the least Av to transfer between 
two circular orbits. His book entitled Die Erreichbarkett the Himmelskorper was 
a pioneering work that showed how to perform interplanetary travel. 


Min. Energy/Velocity 
Transfer Orbit 
= “Hohmann Transfer” 











c 
r| 
b Pi r| 


Figure 12.3: Illustration of a Special Case of Lambert’s Problem with 
Af = 180° 


Hohmann transfer orbits are commonly used when increasing or decreasing 
the radius of a circular orbit. Since Af = 180°, note that 


c=r+re (12.8) 


The minimum energy orbit semi-major axis am is then given by 


1 
Om = 5 (M1 +12 +0) = 5 (12.9) 
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Using the orbit energy equation and the identity in Eq. (12.8), we are able to 
write the velocity magnitude vm, at point P; as 


2 1 
asn(-2) 
Py. am 


= (—*) (12.10) 


TIC 


_ 2h T2 
i Cc TL 


Similarly, we are able to write the velocity magnitude v»,. at point P2 as 


ge pniek (=) (12.11) 
Cc T2 

Note that the vm, expressions in Eqs. (12.10) and (12.11) only depend on the 

initial and final orbit radii r; and rg since c= 71 + ro. 

Now consider not just the minimum velocity orbit, but the family of all 
orbits which pass through the points P, and P2. Further results for the 180° 
special case are obtained by studying the equation of a conic p = r(1+ecos f). 
Since fo = fi +7, we find that 


p=ri(1+ ecos fi) (12.12a) 
p = r9(1 — ecos fi) (12.12b) 


Adding Eggs. (12.12a) and (12.12b) we find 


Eo ed (12.13) 


Tr. Le 
Solving for the semi-latus rectum p yields 


in 2r17re2 = 2r17r2 (12 14) 
7 my +172 Cc i 








which states that p is the harmonic mean of the initial and final orbit radius. 
Note that the above equation only holds for the special case being considered 
where Af = 180°. 

Next we investigate the radial and tangential velocity components. Let the 
position vector be given by r = rz, the velocity vector v is given by 


Vv =f =f, + 1Oig = Upty + Voig (12.15) 


where 6 is the true latitude rate. Using the angular momentum definition h = 
lp = r70, we write the transverse velocity magnitude vg for any orbit transfer 
angle Af as 

riO; _ h? up 


ue =a) = oa (12.16) 
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Figure 12.4: Possible Orbit Solutions to Lambert Problem with 
Af = 180° 


Specializing the transverse velocity expression for the special case of having 
Af = 180°, we substitute the semi-latus rectum definition in Eq. (12.14) into 
Eq. (12.16) to find 


Tr. 


2 
= = (2) for Af = 180° (12.17) 


Note that Eq. (12.17) must hold true for any orbit that connects the given points 
P, and P; which are Af = 180° apart. The transverse velocity magnitude only 
depends on the orbit radii r; and rg. Comparing vg, in Eq. (12.17) to the 
minimum energy orbit velocity magnitude v,,, in Eq. (12.10), we find that 


Up, = Os (12.18) 
Similarly we find 
2u (T1 
v5, = = (2) =Ua, (12.19) 


Thus we can conclude that for the special case of having Af = 180°, that all 
transfer orbits passing through P,; and P2 have the same transverse velocity vg. 
Next we investigate the radial take-off and arrival velocity v,, and v,,. Using 
Eq. (11.141), we are able to write the general orbit radial speed as 
he si 
=f Hem (12.20) 
Pp 


Ur; 


4 
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Adding the radial velocities at P, and P2 we find 


h 
Ur, + Urq = o (sin fr + sin(f, + 7)) (12.21) 
Since sin(f; + 7) = —sin f1, the above equation reduces to the simple relation- 
ship 
Ur, = —Ur, for Af = 180° (12.22) 


From this equation we can conclude that the radial take-off and arrival speeds 
will have equal magnitude and opposite sign for all transfer orbits. 

This very elegant take-off and arrival behavior for the Af = 180° special 
case is illustrated in Figure 12.4. Note that 


|7i| = V6, 


is only true if the transfer orbit is a minimum energy transfer orbit. The locus 
of the take-off and arrival velocity vectors is a straight line. From the energy 
equation we find that 


2 1 
v= fu =p (= - =) (12.23) 


T; a 


Substituting vg, = Um,, the radial take-off and arrival speeds are expressed for 


general transfer orbits as 
2° 11 
ie € — -) (12.24) 
’ Cc a 


Note the elegant similarity of the above equation to the energy equation. If the 
minimum energy transfer orbit semi-major axis ad, = c/2 is chosen (which is 
specialized for the Af = 180° case), then the v,, expressions become zero again. 
This repeats the above conclusion that a minimum energy take-off and arrival 
velocity will only have transverse components. 


Example 12.2: Let us consider the case where a circular orbit of radius ri 
is to be boosted to a higher orbit or radius rz. The minimum energy transfer 
orbit is a Hohmann orbit where Af = 180°. The initial and final circular 
orbits, as well as the Hohmann transfer orbit, is illustrated in Figure 12.5. 
The orbital velocities v1 and v2 of the respective initial and final circular 
orbits are given through the energy equation in Eq. (8.82) as 

Vii= ies 

ri 

Note that for this case the chord is given by c = 71 +72. Using the minimum 
energy transfer orbit to reach the higher circular orbit, the transverse velocity 
ve, that a spacecraft must have at point P; is given by Eq. (12.17). 


2 2 
npeeanee (2) Agia) ota 
Cc Ti c 
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. Hohmann Minimum 
*< Energy Transfer Orbit 





Figure 12.5: Illustration of a Hohmann Transfer Orbit 


Being a minimum energy transfer orbit, no radial velocity will be present at 
this point. Thus, for the spacecraft leave its circular orbit of radius 7; and 
enter the elliptic transfer orbit of semi-major axis @m = c/2, a change in 
velocity Avi is required. 


Avi = v9, — 01 = 01 (2 3 7 (12.25) 


Note that since re > ri that Avi will be positive. Once the spacecraft 
reaches point P2, a second burn will be required to correct the orbit velocity. 
The spacecraft will have the velocity ve, of the transfer orbit given by 


2 2 

2H (=) ected or 

c \re c 
The change in velocity Av2 of the second burn to enter the higher circular 
orbit is computed through 


2r1 


Ave = V2 — Vg = V2 (: = 2) (12.26) 


Cc 


Again, note that this second change in velocity is magnitude is also positive 
since rz > 71. The cost of an orbit transfer is typically given in terms of the 
sum of all required changes in velocities (i.e. burns). For this maneuver, the 
total Av is computed using 


Av = |Av1| + |Ave| 
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Assume the initial orbit had a radius of 7; = 7000 km, and the final circular 
orbit has a radius of r2 = 7200 km. The first burn to enter the elliptic 
Hohmann transfer orbit would require Av; = 52.3541 m/s, while the second 
burn would require a Av2 of 51.9867 m/s. The total cost for raising the orbit 
radius of the circular orbit is Av = 104.351 m/s. 


12.3. Lambert’s Problem 


The two-point boundary value problem of the two-body problem is a classic 
celestial mechanics challenge that was first stated and solved by Johann Heinrich 
Lambert (1728-1779). The goal is to find an orbit which connects to points in 
space with a given flight time. Today this problem is commonly solved when 
controlling and targeting spacecraft or directing missiles in an inverse-square 
gravity field. 





Figure 12.6: Illustration of the Two-Point Boundary Value Problem of 
the Two-Body Problem 


The geometry of Lambert’s Problem is illustrated in Figure 12.6. The initial 
position vector is given by r,; and the final position vector is rg. All position 
vectors are measured relative to the source of the dominant inverse gravity field. 
As such, this source will be the focus F' of any elliptic orbit that will connect 
position r; to position rg. For example, if the objective is to travel between 
two planets, then the gravity source during the interplanetary flight would be 
the Sun. The unoccupied focus is denoted by F’*. The true anomalies f; are 
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measured relative to periapses, with Af being the angular change between the 
initial and final position vectors. The chord vector c is relative vector between 
the final and initial positions. Given 7,1, rg and a time of flight At = tg — ty, 
Lambert’s problem seeks to find the orbit which will connect the two positions 
at the given times. 

To solve this problem, this section presents a general numerical iteration 
technique to solve this two-point boundary value problem. This method ap- 
plies to un-perturbed gravity field case, as well as the perturbed gravity field 
case. The reader is referred to Battin’s chapter on Lambert’s problem in Ref- 
erence 1, where he develops a very elegant analytical solution to Lambert’s 
problem. However, this solution is only applicable if there are no perturba- 
tions to the inverse-square gravity field. The general solution presented in this 
chapter makes use of the state transition matrix and can be applied even if 
gravitational perturbations are present. To start the iteration, the elegant and 
convenient concept of the minimum energy orbits is employed. As suggested by 
Battin, the convergence and stability of the numerical iteration is improved if 
this orbit is used as the initial solution guess of the two-point boundary value 
problem. The solution to Lambert’s problem is full of very elegant and beautiful 
properties. This section will discuss two some elegant properties of the departure 
and arrival velocity vectors of the two-point two-body boundary value problem. 


12.3.1 General Problem Solution 


A common method to solve a general two-point boundary value problem is to 
employ a numerical iteration technique called the “shooting-method”. Given the 
initial and final states x(t;) and x(t2), as well as a desired transfer time At, the 
shooting method technique starts out with a guess of the initial velocity «(t1). 
After integrating the trajectory to obtain the state #(t2), the final targeting 
error 


5x(t2) = #(t2) — x(t2) (12.27) 


is computed. Using the sensitivity of the final position to the initial velocity, the 
initial velocity estimate is updated using the local-linearization based Newton 
method: 





fo Nasitan cif OMEN 
ay (sa) 5ar(ty) (12.28) 


The initial velocity is successively updated until the target error éx(t2) has 
become sufficiently small. The success of this iterative technique depends on 
the nonlinearity of the governing differential equations, as well as the quality of 
the initial guess. If the guess is very poor and the problem is highly nonlinear, 
then the shooting method may not converge to the true answer. The more linear 
the problem is, the more accurate the initial velocity updates in Eq. (12.28) will 
be and the more successful the application of the shooting method will be to 
solve the two-point boundary value problem. 
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To solve Lambert’s problem, a slightly modified version of the shooting 
method is proposed since the governing differential equations are relatively sen- 
sitive to the initial velocity vector guess. A good estimate of this vector is 
required for the standard shooting method to converge. The problem statement 
provides us with the initial position vector r; and the desired position vector 
ro with a flight time of At. To start the numerical iteration, we don’t simply 
choose an arbitrary initial velocity vector 7;. Instead, we choose a velocity 
vector which results in a motion that will reach point rz precisely, though not 
necessarily at the desired time tz. We will show how to construct such a solution 
using a minimum energy orbit transfer. This will provide us with the required 
initial velocity vector. Note that in principle any transfer orbit could be used. 
It is not required to use the minimum energy orbit as the initial guess. However, 
as pointed out by Battin in Reference 1, the convergence and stability of solving 
Lambert’s problem is increased if this minimum energy transfer orbit is used as 
the initial guess. 

A flow diagram of the modified shooting method to solve Lambert’s problem 
is shown in Figure 12.7. This continuation method is often used in numerical 
iterations. Assume the initial velocity estimate 7, results in a transfer time of At 
and zero final tracking error. Whereas the standard shooting method attempts 
to solve the two-point boundary value problem in one go, the modified shooting 
method employed here solves a series of neighboring two-point boundary value 
problems which gradually lead to the desired answer. The benefit here is greatly 
increased convergence and stability of the numerical iteration method. The 
transfer time Af of each successive two-point boundary value problem is swept 
linearly from the initial transfer time of At to the desired transfer time of At. 
The initial guess will result in no final tracking error. As the transfer time Af 
slowly approaches the desired transfer time At, the initial velocity vector 71 is 
iteratively adjusted such that the final tracking errors remain within a certain 
tolerance «. By starting out with a set of states (*,, At) that do reach the 
desired rz, and then gradually adjusting the flight time to the desired flight 
time, the numerical iteration technique will never encounter very large final 
tracking errors. This makes the state transition matrix computed initial velocity 
corrections more accurate and the overall convergence time is decreased. 

To compute the state transition matrix [072/07], the analytical solution 
given in Eq. (11.248c) could be used. This equation is valid if forces are per- 
turbing the two-body Keplerian motion. If large perturbations are present, 
then this state transition matrix should be computed using standard numerical 
techniques. 

To find a initial velocity vector which results in an orbit that connects the 
position vectors r; and r2 precisely, we recall the Lagrange F and G solution to 
the orbit motion in terms of a true anomaly difference Af. Using Eqs. (8.148) 
and (8.177) we are able to relate the velocity vectors 7, and 2 to the specified 
position vectors r; and r2 through 


T2 => Fr, + Gr, (12.29) 
r, = Gro — Gry (12.30) 


SECTION 12.3 LAMBERT’S PROBLEM 445 







At =a At+(1—a@)At 


1 


oF ee 


rj =r\- rr 
new old ry 


Initial Velocity Update Law 


Shooting Method to Solve 2-Point Boundary Value Problem 


Figure 12.7: Flow Diagram of the Modified Shooting-Method to Solve 
Lambert’s Problem 
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Solving these two equations for the velocity vectors of interests yields 


1 


Ty = G (r2 = Fr;) (12.31) 
: 1 : 
haa (=r Za Grz) (12.32) 


with the functions F, G and G being defined in Eqs. (8.183), (8.184) and (8.187) 
as 





F=1-2(1—cosAf) (12.33) 
p 
PIED i 
G= sinA 12.34 
ip aoe 
G=1-— (1 cos Af) (12.35) 


Substituting Eqs. (12.33) - (12.35) into the velocity vector expressions in Eqs. (12.31) 
and (12.32) yields the desired initial and final velocity expressions 


fy ES le a (1 — cos Af) n| (12.36) 


rire sin Af 





2 = Ds |e + = (1 —cosAf) r (12.37) 


riresin Af 


where c = rg—1 is the chord vector. Eq. (12.36) provides us with a convenient 
method to compute an initial velocity vector guess which will generate an orbit 
that connects the two position vectors r; and rp. However, this orbit will 
generally not have the required transfer time. Note that the only unknown 
parameter in Eq. (12.36) is the parameter p. All other parameters are specified 
through the problem statement. For the non-perturbed Keplerian orbit case, 
solving Lambert’s problem can be reduced to a one-dimensional search for an 
orbit with the proper energy such that the desired transfer time is achieved. The 
transfer orbit plane itself is defined by the vectors r; and rz. Battin presents 
in Reference 1 Lagrange’s classical solution to this two-point boundary value 
problem which involves a one-dimensional search for the proper transfer orbit 
semi-major axis. The development of this elegant solution to the unperturbed 
Keplerian motion case is not covered in this chapter. 

While Eq. (12.36) will yield a suitable initial velocity vector guess 7 , we still 
require the associated transfer time At. Given the orbit equation in Eq. (8.6), 
we are able to establish the following two identities at times t; and te: 


Ae 2 
een pee (12.38) 
TL TL 
ali 2 
e(cos frcos Af —sinfismAf)= 2-1-0079) 4 (12.39) 
a” 2 2 


cos f2 
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These two equations contain the three unknown parameters e, f; and p. If 
p = a(1—e?) is used, then the semi-major axis a replaces the semi-latus rectum 
pas a free parameter. By choosing either an initial p or a, the two equations in 
Egs. (12.38) and (12.39) must be solved simultaneously for the corresponding 
orbit eccentricity é and initial true anomaly f,. Given f; and fo = f; + Af, as 
well as the eccentricity €, we are able to compute the corresponding eccentric 
and mean anomalies. The transfer time of the initial transfer orbit guess is then 
given through Kepler’s equation: 


Ai= /= re = Nh) (12.40) 


To use the minimum energy orbit as an initial guess for solving Lambert’s 
problem, we first compute a,,, and then solve Eqs. (12.38) and (12.39) for the 
transfer orbit initial true anomaly f; and eccentricity e. With these parame- 
ters, we are then able to compute the required initial velocity vector 7, using 
Eq. (12.36) and the minimum energy orbit transfer time At using Eq. (12.40). 

This completes the required steps to solve Lambert’s two-point boundary 
value problem of the two-body problem using the modified shooting method. 
While this method works with a standard two-body problem, it will also work 
for more general boundary value problems where the gravity field contains some 
perturbations. 


12.3.2 Elegant Velocity Properties 


In Eqs. (12.36) and (12.37) we developed the necessary orbit velocities such that 
the corresponding transfer orbit will contain the points P,; and P2. Some very 
elegant geometric interpolations can be arrived at by investigating these velocity 
vectors in the non-orthogonal coordinate system (%¢,@,;), where @, is the unit 
vector of the chord vector and 7,, is the unit vector of either the initial or final 
orbit radius vector. This coordinate system is illustrated in Figure 12.8. 

Using these unit coordinates, the initial and final velocity vector of any 
transfer orbit is written in the compact form 


P1 = Uptr, + Vebe (12.41) 
12 = —Uptr, + Vete (12.42) 


with the velocity vector component v, along the orbit radius being given by 


_ fu f1—cosAf 
Up = /e (>) (12.43) 


and the vector component vu, along the chord c being given by 


(EE (12.44) 


~ ryrosin Af 
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Figure 12.8: Geometric Interpretation of the Solution to the Two-Point 
Boundary Value Problem of the Two-Body Problem 


Note that v. must be equal for any orbits that connects the points P,; and P3. 
The initial and final velocity vector components along the initial and final orbit 
position vectors have the same magnitude, but opposite sign. 

To investigate on what curve all possible take-off and arrival velocity vectors 
will lie, we look at the product of vp, and v,:' 


Dep = pe (>) (12.45) 


T1472 sin Af 


Using several trigonometric identities, this product can be written in the com- 


pact form 
A 
vetp = —— sec? ($+) (12.46) 


T1712 





Note that the right hand side of this product depends solely upon the triangle 
formed by the position vectors rj and rz. Thus, all infinity of orbits passing 
through P; and P have the property that v.v, = (const)?. At first glance 
this property may not be recognized. However, Eq. (12.46) is the equation of a 
hyperbola in asymptotic coordinates. 

Let us digress briefly and study the hyperbola expressed in terms of asymp- 
totic coordinates to establish this truth. Figure 12.9 shows a hyperbola with 
coordinates (x,y) relative to an orthogonal base vector set {€2,é,} and with 
asymptotic coordinates (X,Y) relative to the non-orthogonal base vector set 
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{éx,éy}. Note that the hyperbola will asymptotically approach the direction 
vectors €x and éy, with w being the slope angle of the hyperbola asymptote 
relative to the é, axis. 





Figure 12.9: Equation of a Hyperbola in Asymptotic Coordinates 


Studying Figure 12.9 carefully, we find the relationship between the orthog- 
onal and non-orthogonal coordinates to be 


g=(X +) cos (12.47a) 
y= (Y —X)sinv (12.47b) 
The equation of a hyperbola in terms of orthogonal coordinates (x, y) is 
ey? 
a be 


=1 (12.48) 


where the hyperbolic semi-major axis a is defined to be a negative quantity and 
b=av1 — e?. Substituting Eqs. (12.47a) and (12.47b) into Eq. (12.48) we find 


(X?42XY+Y?)cos?y (X?-2XY+Y?)sin? 


7 =A (12.49) 


In Eq. (8.26) we found the useful relationship 
b? = a? tan? w (12.50) 


Using this identity, the equation of a hyperbola is written in terms of the asymp- 
totic coordinates (X,Y) as 


2 
XY= = sec? w = constant (12.51) 


Comparing Eqs. (12.46) and (12.51), it is apparent that the product u,v, indeed 
describes a hyperbola in terms of asymptotic coordinates with the hyperbolic 


semi-major axis being 
2 
a=,/— (12.52) 
T17T2 
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Figure 12.10: Illustration of the Velocity Vector Locus 


The geometric interpretation of this hyperbola is shown in Figure 12.10. 
Note that the loci of all velocity vectors leaving point P, going through point 
P» lie along a hyperbola. Additionally, this hyperbola is completely established 
by the triangle F'P;P2. Studying Figure 12.10 the minimum velocity orbit is 
easily found to be such that 


Up = Ve (12.53) 


Also, the direction of the minimum velocity vector r,,, is such that its unit 
vector bisects the angle $1. 

Compare the general minimum velocity transfer orbit condition in Eq. (12.53) 
to the minimum velocity orbit conditions for the special case where Af is pre- 
cisely 180 degrees. As Af — 180°, the hyperbola of take-off velocity vectors loci 
becomes a rectilinear curve collinear aligned with the r; position vector. Simul- 
taneously the asymptotic velocity coordinates v, and v, will go to zero for the 
minium velocity solution. This agrees with the Af = 180° special case which 
concluded that a corresponding minimum velocity orbit would have zero radial 
take-off velocity. Similarly, as Af — 180°, the minimum velocity take-off vector 
fm, Will become perpendicular to the r; position vector. Again this agrees with 
the Af = 180° special case condition which states that the minimum velocity 
transfer orbit will only have a transverse velocity component. 


12.4 Rotating the Orbit Plane 


The previous orbit maneuvers all had in common that they strive to move a 
spacecraft from one point in space to another point. In this section we will 
investigate a different type of orbit maneuver. Here the goal is to change the 
orbit plan orientation, without necessarily affecting the orbit geometry itself. 
Assuming the spacecraft is undergoing Keplerian (non-perturbed) motion, 
then its orbit plane is fixed in inertial space. The orientation of any plane is 
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Original Orbit Plane 


Figure 12.11: Illustration of an Orbit Plane Change Maneuver 


completely prescribed through a unit normal vector to this plane. For the case of 
having a Keplerian motion, the angular momentum vector h; = r x v; provides 
such an orbit-plane normal vector. Let the desired orbit plane orientation be 
given through the angular momentum vector hg = r X vg. These two orbit 
planes are illustrated in Figure 12.11. The difference in angular momentum 
vectors is given by 


Ah=ho—hi (12.54) 


Let the axis which which intersects the two orbit planes of interest be given be 
described through the unit direction vector n,. Note that since both orbit planes 
are inertially fixed, so is n, inertially fixed. Let n, be the unit direction vector of 
the original angular momentum vector hi, then we can define the inertial frame 
N : {fiz, My, nz}, where ’, completes the right-hand coordinate system. The 
orbit plane orientation change is described through the scalar angular parameter 
Ai. As shown in Eq. (2.38), the rate of change of the angular momentum vector 
h is equal to the torque EL applied to the spacecraft. 


h=L=rxo (12.55) 


Assuming the orbit plane change is applied impulsively, we are able to rewrite 
Eq. (12.55) as a difference equation between angular momentum and velocity 
vectors. 


Ah=rx Av= hy =< hy (12.56) 
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To determine what velocity change Av must be applied at which point r of the 
original orbit, we write these two vectors with inertial WY components as 


T= Ty, +Tyty (12.57) 
Av = Avgnz + Atytty + Aun, (12.58) 


Studying Figure 12.11, it is clear that the angular momentum vector change 
Ah will not have any vector component along the mz, axis. Thus, Ah can be 
written in terms of inertial A’ frame components as 


Ah = —Ahyf, — Ahzirz (12.59) 


with the angular momentum change vector components Ah, and Ah, being 
given by 


Ah, = hisin Ai (12.60) 
Ah, = hy (1 — cos At) (12.61) 


Substituting Eqs. (12.57) and (12.58) into Eq. (12.56), the angular momen- 
tum difference Ah is expressed as 


Ah=T,Au,n, —frrAun, + (r2Avy —Ty Avs) fiz (12.62) 


By comparing the NV frame components of Eqs. (12.59) and (12.62), we are 
able to make the following conclusions. Since the angular momentum change 
along the n, axis is non-zero, neither the position vector component r, nor the 
velocity vector difference component Av, can be zero. Thus, since there is no 
angular momentum change along the n, axis, the position vector component 
ry must be zero. This provides us with the intuitive solution that the orbit 
plane change will occur at the point r = r,nm, where where the two orbit planes 
intersect. Note that r, could be either positive or negative, depending on which 
of the possible two intersection points is used to perform the orbit plane change. 

Let us write the orbit velocity vector v; in terms of NV frame components as 


01 = Tete + refily = Vsti + Vyhy (12.63) 


Using the angular momentum property h, = r2 f , and by comparing the vector 
components along the remaining two axis of the NV frame, the velocity vector 
change vector components are in terms of the desired orbit plane difference angle 
Ai as 


Av, = arbitrary (12.64) 
Avy = —vy (1 — cos At) (12.65) 
Av, = vy sin Ai (12.66) 


Since Av, is arbitrary, while Av, and Av, must have specific values, the mini- 
mum energy orbit plane change is achieved by setting Av, equal to zero. Let us 
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further examine what happens to the orbit energy v?. Using the orbit velocity 
N frame vector components shown in Eq. (12.63), the orbit energy v3 is found 
to be 


3 = (ve + Avy)? + v2 (1 — (1 — cos Ai))” + v? sin? Ad 


(Uz + Avr)? + uy, = v2 + 2u,Av, + Av? 


UV 


(12.67) 








I 


Thus, for the minimum energy orbit plane change where Av, = 0, we find that 
v3 = vz. Therefore the orbit energy is not changed during such a plane change. 
Practically, this means that a minimum energy orbit plane change will only 
change the orbit plane itself, but will not affect the orbit geometry (semi-major 


axis and eccentricity). 






Original Orbit Plane 


Figure 12.12: Side View of Velocity Vectors Involved in a Minimal En- 
ergy Orbit Plane Change Maneuver 


Figure 12.12 illustrates what happens to the orbit velocity vectors during the 
orbit plane change maneuver. The tangential velocity component v, is simply 
rotated by the Av velocity correction to lie in the desired orbit plane. The 
radial velocity component v, is unaffected by the orbit plane change if Av, is 
equal to zero. However, since the magnitudes of the Av components are directly 
a function of the tangential orbit velocity vy, performing a orbit plane change 
is a very costly maneuver that requires a relatively large Av. 


Example 12.3: To illustrate how much Av is required to perform a orbit 
plane change, we revisit initial circular orbit used in Example 12.2. In that 
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example, an initial circular orbit radius of 7000 km was increased to a circular 
orbit of 7200 km through a Hohmann orbit transfer. The total velocity change 
required for that maneuver was Avy = 104.351 m/s. Using the same fuel 
cost, let us see just how far we would be able to rotate the initial orbit plane. 
Summing the terms in Eqs. (12.65) and (12.66), the total fuel budget for the 
minimal energy orbit plane change is given by 


Av = vyv/2(1 — cos Ai) (12.68) 


Solving this equation for the desired Ai we find 


2 
Ai = cos + (: _ Z (=) 
2 \ vy 


Given an orbit radius of rz = 7000 km, the tangential orbit velocity vy is 7460 
m/s. For a given allowable Av, the achievable orbit plan rotation angle Az 
is only 0.80°. This corresponds to a maximum out-of-plane separation from 
the original orbit of 97.92 m. 


Example 12.4: Using Gauss’ variation equations in Eqs. (11.153), we saw 
how a continuous external disturbance acceleration a = (ar, ao, an) will affect 
the orbit element rates. We could also use Eq. (11.153c) to find how a 
continuous thrust is used to change the orbit inclination angle i. This equation 
is repeated here for convenience. 

di _ rcosé 

We 
where @ is the true latitude angle. The orbit inclination angle is easiest to 
adjust while crossing the equatorial plane with 6 = 0. Using h = rvy, we find 
the Av requirement for a desired Ai inclination change to be 


Avn = Vy Ai 


Note that this equation is obtained by integrating the continuous disturbance 
equation over a small time interval At. At first glance this equation appears to 
differ from Eq. (12.68). However, if we linearize Eq. (12.68), i.e. assume that 
the orbit inclination change Az is small, it agrees with the Av requirement 
developed in this example. 


Note another important detail. Gauss’ equations form a set of continuous 
differential equations for the orbit elements in terms of the disturbance accel- 
eration vector components a,, dg and a;,. Note that these vector components 
are taken relative to the rotating spacecraft fixed reference frame {2,, 29, tn}. 
Since the impulsive thrust is approximated to be a continuous thrust over a 
small period of time At, the orientation vector @;, is time varying through-out 
this maneuver. Thus, the Av; requirement shown above is to to be taken in 
a straight-line manner. Rather, it forms the arc length as the current velocity 
vector component vy, is rotated to the desired orbit inclination angle. 
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12.5 Patched-Conic Orbit Solution 


In Section 10.5 we discussed the concept of gravitational spheres of influence. 
The idea is that the gravity field of a multi-body system can be locally approx- 
imated about a single body through the inverse square gravitational field. This 
concept is illustrated in Figure 12.13. Assume that m, >> mg, then the local 
gravitational sphere of influence about m2 is approximated in Eq. (10.80) as 


arte 
r= (=) ri (12.69) 


Note that this formula was derived seeking the surface where the gravitational 
accelerations due to either body are equal. Different formula exists to compute 
the approximated spherical region of influence. However, to be used in the 
method of patched-conic orbits, the resulting energy approximations are rather 
insensitive to the choice of sphere of influence radius formula selection. 


m Sphere of Influence 





Figure 12.13: Illustration of the Concept of Gravitational Spheres of 
Influence 


When a spacecraft is traveling among several celestial bodies, then the trans- 
fer orbit can be dissected into a finite number of section using the concept of 
gravitational spheres of influence. At any instance of time, the gravitational 
attraction acting on the spacecraft is assumed to be originating solely from the 
local dominant gravitational influence. For example, using the illustration in 
Figure 12.13, assume that m, is Earth and m2 is the Moon. As the spacecraft 
enters a transfer orbit from the Earth to the Moon, its initial trajectory is es- 
sentially a solution of the classical Keplerian two-body problem. Only as the 
spacecraft becomes sufficiently close to the Moon is its gravitational attraction 
dominated by the Moon. To find an initial transfer orbit guess, or to approxi- 
mately evaluate what Av’s would be involved in reaching the Moon, the transfer 
orbit can be split into two regions where the spacecraft is considered to be under 
the sole influence of either the Earth or the Moon. This method of dissecting 
a transfer orbit into various sections of two-body solutions is referred to a the 
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method of patched conics. To determine a precise transfer orbit, a numerical 
solution technique must be employed which incorporates the gravitational in- 
fluence of all celestial bodies, as well as any other existing perturbations, at any 
instance of time. The most common use of the patched-conic orbit solution is to 
determine approximately what Av’s would be required for a proposed mission or 
to find an initial orbit guess that will start a numerical orbit search algorithm. 
We mention that the patched conic method is known to be much more valid 
in estimating the magnitude of Av, rather than establishing the direction and 
timing of the velocity changes. 


While in transit between two planets, an interplanetary spacecraft will spend 
most of its time under the dominant gravitational influence of the Sun . Investi- 
gating the feasibility of interplanetary missions, the concept of the patch-conic 
orbits is very useful. A sample orbit between Earth and Mars is illustrated in 
Figure 12.14. While the spacecraft is in the Earth’s sphere on influence, it is 
shown to be on a hyperbolic orbit relative to Earth. As the spacecraft leaves 
the Earth’s sphere of influence, it continues on under the gravitational influence 
of the Sun. Even though we had a hyperbolic orbit relative to Earth, at this 
point the spacecraft velocity (energy) relative to the Sun is only sufficient to 
yield an elliptic orbit with the Sun as its focus. Although both the Earth and 
the Sun attract the spacecraft, the Sun is ignored inside the Earth’s sphere of 
influence, and the Earth is ignored outside it’s sphere of influence. After the 
long heliocentric orbit transit phase, the spacecraft finally enters Mars’ sphere of 
influence. What type of orbit the spacecraft will have relative to Mars depends 
on the relative velocity magnitude of the craft. However, since it’s velocity at 
infinity is nonzero, we can anticipate a hyperbolic planet centric orbit from the 
onset. The illustration in Figure 12.14 depicts the expected hyperbolic orbit of 
the spacecraft relative to the target planet. 











Figure 12.14: Approximating a Trajectory Among Multiple Celestial 
Bodies Through Gravitational Spheres of Influences 
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12.5.1 Establishing the Heliocentric Departure Velocity 


Note that the transit orbit between the two planets can be chosen to fit the 
mission requirements. To find the minimum energy transfer orbit to boost a 
spacecraft from Earth’s orbit to another planets orbit, a Hohmann transfer 
ellipse would be chosen. A sample Hohmann transfer orbit from Earth to Mars 
is illustrated in Figure 12.15. A major benefit of Hohmann transfer orbits is 
that the spacecraft approach trajectory will asymptotically approach the target 
planet trajectory at the rendez vous point. The approach speed will also be 
relatively slow. Without the target planet’s gravitational field present, the craft 
would not have the proper heliocentric velocity to remain in this orbit. However, 
if guided properly, it is possible for the spacecraft to enter the local planet’s 
gravity well and, with a modest energy charge, remain in a closed orbit about 
this planet. Depending on the target orbit, only small Av orbit corrections 
would be necessary to achieve this final planetary orbit. 


ato 








Figure 12.15: Hohmann Transfer Orbit Illustration between Earth and 
Mars 


Example 12.2 illustrates how to compute the total Av required to perform a 
Hohmann transfer between two circular orbits. For the interplanetary Hohmann 
transfer, we only make use of the first Av, calculation in Eq. (12.25) that yields 
the required heliocentric departure velocity v;. At the end of the Hohmann 
transfer, no second burn is performed to circularize the spacecraft orbit about 
the Sun. Instead, the spacecraft is guided and controlled in such a way that the 
craft is captured by the target planets gravity well. The total Av requirement 
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to perform this capture depends on the target orbit geometry and orientation. 

Using the average planetary orbit radii shown in Table 10.1, we can compute 
the minimum heliocentric (measured relative to the Sun) Av requirement to 
depart Earth’s orbit and arrive at any other planet in our solar system. The 
required Earth departure Av’s are computed using Eq. (12.25). The results are 
shown in Table 12.1. Note that a negative Av means that the spacecraft must 
slow down relative to Earth in order to reach this planet. As a comparison, the 
Earth’s heliocentric speed is 29.77 km/s. The negative Av entries for Mercury 
and Venus indicate that the craft must exit the Earth’s sphere of influence in 
the opposite direction to the Earth’s counter-clockwise motion. Through this 
the apofocus counter-clockwise velocity will be appropriately reduced so that 
the craft ”falls” interior to the Earth’s orbit and arrives at either planet at 
perifocus. 


Table 12.1: Minimum Av Requirements to Reach Other Planets While 
Departing From Earth 


Departure Transfer 
Planet Av [km/s] Time [years] 
Mercury 9 -7.53 0.29 
Venus 9 -2.50 0.40 
Mars C 2.94 0.71 
Jupiter 2: 8.79 2.73 
Saturn h 10.29 6.07 
Uranus 6 11.28 16.06 
Neptune V 11.65 30.71 
Pluto B 11.81 45.66 


The results in Table 12.1 provide only rough estimates of the minimum 
energy Av requirements and flight times. This simple calculation ignores any 
orbit plane changes that might be required, as well the Av requirement to escape 
the departure planets local gravity field or the Av requirement to park in an 
orbit about the arrival planet. Even so, it is clear that the fuel requirements to 
reach all the outer solar system planets with a minimum energy transfer orbit 
are about the same. However, the flight time to reach Uranus, Neptune and 
Pluto become very large and vary substantially from each other. The reason 
for the small change in fuel requirements to the outer planets is that the Sun’s 
gravitational attraction is much smaller in the outer reaches of our solar system 
then in the proximity of Earth. In all cases to the outer planets the Earth 
relative departure velocity is approaching the escape speed of approximately 
12.33 km/s. The interplanetary spacecraft will require most of the fuel to travel 
through the inner solar system. Traveling from Saturn on to the outer planets 
(or escaping the solar system) will only take a relatively minor addition in Av 
requirements. 

To have the spacecraft actually intercept the target planet when it reaches 
the desired heliocentric orbit radius, the departure and target planets true 
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anomaly angles must have a specific phase difference 7(t1) at the time of the 
spacecraft launch corresponding to the trip time. Let Af be the angular dis- 
tance that the spacecraft will travel relative to the Sun while in transit between 
planets. The associated travel time is given by AT’. Let n, be the mean angular 
rate of the departure planet about the Sun, while nz is the mean angular rate of 
the target planet. Since the target planet will have traveled an angular distance 
of nzAT while the spacecraft is in transit, the initial phase angle between the 
departure and target planets must be 


¥(t1) = Af — n2AT (12.70) 


If a launch cannot be performed while the planets are at this particular phase 
angle, then the mission planners must wait until the planets have rotated suffi- 
ciently for this launch condition to repeat itself (or choose to use a sub-optimal 
transfer orbit). How long this wait will be depends on the synodic period be- 
tween the departure and target planet. A synodic period T, is defined as the 
time required for a particular phase angle between the planets to repeat itself.4 
To compute the synodic period T,, let us assume that the planets are at a de- 
sired phase angle y at the initial time. For this angle to repeat itself, after 
a period T, the angular difference between the planets must have changed by 
+27. 








(Ts) = y(to) + neT; — mT, = y(to) 4 20 (12.71) 


From this condition, the synodic period T, is expressed in terms of the planets 
heliocentric rotations rates n; as* 


20 


(a 
|n2 — 4 


(12.72) 
Assuming that the interplanetary spacecraft is departing from Earth, Table 12.2 
shows the synodic periods for the various launch windows to repeat themselves. 
Note that if there is a large difference in the planetary rotation rates n;, then 
the synodic periods will be relatively short. For example, the angular rate ng of 
the planet Mercury is about 4 times larger than that of Earth. By the time that 
Mercury finishes one revolution about the Sun, Earth will only have rotated a 
relatively small distance. To catch up to the required phase angle y will only 
take a short time. This is why the synodic period between Mercury and Earth 
is only slightly larger than the revolution period of Mercury. On the other 
hand, the synodic periods between Earth and the outer planets is essentially 
one Earth year. In this case Earth is considered to be the fast planet, while 
the outer planets are almost standing still in comparison. It takes Neptune and 
Pluto over 100 years to finish one revolution about the Sun. However, as the 
difference in heliocentric rotation rates becomes small, then it can take a long 
time for the required planetary phase condition to repeat itself. This is why the 
synodic periods between Earth and Mars or Venus are the largest. 

Besides requiring potentially long transit times and perhaps extended waits 
for favorable planetary positions, using a pure Hohmann transfer for interplane- 
tary travel has other drawbacks. If the spacecraft is to travel by another planet 
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Table 12.2: Synodic Periods between Earth and Other Planets 


Heliocentric Ang. Revolution Period Synodic 
Planet Rate [deg/year] about the Sun [years] _ Period [years] 
Mercury 9 1493.04 0.24 0.318 
Venus Q 584.60 0.62 1.600 
Mars O 191.20 1.88 2.138 
Jupiter 2 30.30 11.88 1.093 
Saturn h 12.18 29.57 1.036 
Uranus 6 4.27 84.17 1.013 
Neptune VU 2.17 165.40 1.007 
Pluto B 1.45 248.81 1.005 


and then return to Earth, the craft will return to the point in space where Earth 
was when the spacecraft was launched. However, in the mean time Earth will 
have moved on to a new position about the Sun. For a free-return fly-by type 
mission, the Hohmann transfer orbit would need to be abandoned to guarantee 
that the spacecraft will reach both the other planet and Earth during its return 
flight. 


Example 12.5: Let us investigate a simplified heliocentric Hohmann transfer 
orbit between Earth and Mars as shown in Figure 12.15. This example illus- 
trates how the values in Table 12.1 were obtained. Both planetary orbits are 
assumed to lie in the same plane and have zero eccentricity. The simplified 
geometry is illustrated in Figure 12.15. 

The gravitational constant of the Sun is po = 1.326 - 10"? km? /s?. Earth’s 
average heliocentric radius is r@ = 149.60 - 10° km, while Mars’ average 
radius is ro = 227.94- 10° km. The planet’s mean rotation rate about the 
Sun is then computed through 


ne = — = 0.985 deg/day 
"@® 

ng = [fe = 0.985 deg/day 
ro 


The Earth’s heliocentric velocity magnitude v@ is 


ve = ,/E2 = 29.77 km/s 
re 


The semi-major axis of the minimum energy transfer orbit is computed using 
Eq. (12.9). 

_ retro 

a cle 
Since the Hohmann transfer ellipse is only traveled from the periapses to the 
apoapses (half an orbit), the transfer time AT is 


dl a3 
AT = = | 27,/— | = 258.98 days 
2 LO 
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The angular distances that the planets travel while the spacecraft is complet- 
ing its transfer orbit are 


fo =n@ - AT = 255.13 deg 
fo =no - AT = 135.66 deg 


Studying these angles, it is evident how critical timing is when performing 
any interplanetary missions. When the spacecraft is departing the Earth's 
sphere of influence, Mars must be 135.66 degrees away from the rendez vous 
point. This is generally not the case. Mission planners must therefore look 
at the Earth and Mars motion and plan their launch windows accordingly. If 
the different orbit inclinations and eccentricities are also taken into account, 
then the launch window calculation become more complex. 


To be able to intercept a planet at a specific time, Lambert’s two-point 
boundary value problem would need to be solved. This is illustrated in Fig- 
ure 12.16 as a non-Hohmann transfer orbit between Earth and Mars. This 
method allows us to specify the spacecraft to be at a desired location at a de- 
sired time. However, care must be taken when choosing the intercept time and 
place to avoid large Av requirements. To find an optimum solution taking both 
fuel consumption and time of flight considerations into account, a numerical op- 
timization is typically performed taking all gravitational attractions and other 
perturbations into account. 

Another concern of such faster transfer orbits is that the spacecraft’s ap- 
proach trajectory tangent will not asymptotically approach the arrival planets 
trajectory target. Instead, the craft may approach the target planets trajectory 
at an oblique angle. The relative approach speeds are often very high and have 
different directions. So, while the transfer orbit time has been reduced, it may 
take longer to insert the craft in a desired orbit about the target planet. Due to 
deceleration and/or propulsion constraints, this is may be performed in multiple 
steps. 


12.5.2 Escaping the Departure Planet’s Sphere of Influence 


Previously we discussed methods to find the required heliocentric velocity v; 
that a spacecraft will need to travel from one planet and travel to another. 
In the following discussion we will investigate how a spacecraft will escape the 
gravitational influence of the departure planet. As a general notation heliocen- 
tric velocity magnitudes are expressed as v;, while velocity magnitudes relative 
to either the departure or target planets are expressed as vj. 

Let us examine how a spacecraft would travel through the gravitational 
sphere of influence of the departure planet. As the spacecraft exits the planets 
sphere of influence, its velocity must have a know magnitude v, and direction. 
Without loss of generality, let us assume that the interplanetary transfer is a 
minimum energy Hohmann transfer ellipse and that the departure planet is 
Earth. According to Eq. (12.17), the heliocentric departure velocity vector v1 
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Figure 12.16: Non-Minimum Energy Transfer Orbit Illustration be- 
tween Earth and Mars 


must be aligned with the Earth’s heliocentric velocity vector. Further, let us 
assume that the spacecraft is initially in a circular orbit about the Earth at a 
radius ro. 

To depart Earth’s sphere of influence, either a parabolic or hyperbolic orbit 
is required relative to Earth. As the Earth relative position vector grows large, 
we required the velocity vector to be aligned with the heliocentric Earth velocity 
Ve. Figure 12.17 illustrates the departure hyperbola from Earth both an outer 
or inner solar system planet. If the spacecraft is to travel to an outer planet, 
Table 12.1 shows that a positive Av is required. Thus the spacecraft needs 
to accelerate relative to the heliocentric Earth velocity. If the spacecraft is to 
travel to an inner planet, then a negative Av is to be applied and the craft has 
to slow down relative to Earth. 

As the departing spacecraft approaches Earth’s sphere of influence, its ve- 
locity vector must have converged sufficiently to the required magnitude v; and 
direction. If the parking orbit radius rp is large compared to the sphere of 
influence radius, then this may not occur. 

Let the time tg be the time where the spacecraft performs a burn to leave 
its circular orbit about Earth and enter a hyperbolic departure orbit. The time 
t, is defined as the an instance where the departure orbit intersects the planets 
sphere of influence. The required Earth relative velocity nui that the spacecraft 


SECTION 12.5 PATCHED-CONIC ORBIT SOLUTION 463 







| towards the sun 


Earth Sphere 
of Influence 





Asymptote of Hyperbolic Departure Orbit 


(i) Departure Orbit to Reach Outer Planet 








Earth Sphere 
of Influence 
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Figure 12.17: Earth Relative Hyperbolic Departure Orbit Illustration 
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must possess as it approaches the sphere of influence is computed using 
Vy = V1 — ve (12.73) 
The vis-viva equation of a hyperbolic orbit about Earth is given by 


2 — 2He _ He 
‘i T; a 





(12.74) 


where the semi-major axis of a hyperbola is defined to be a negative quantity. 
Since the spacecraft trajectory will have asymptotically approached its hyper- 
bolic asymptote at t1, we can approximate r; ~ oo. Using Eq. (12.74), the 
Earth relative spacecraft velocity 11 is then given by 


2 
se EE SEOs Ee (12.75) 
T1 a a 


The semi-major axis a of the departure hyperbola is then expressed in terms of 
the departure velocity v1 or v; through 


a=-3--_" _ (12.76) 


The Earth relative speed vp that the spacecraft must have after the burn to 
enter the hyperbolic orbit at to is 


uate eae (12.77) 


ro 
After substituting Eq. (12.76), the speed vp is expressed as 


Ze 
TO 


vy=wi+ (12.78) 


While in the circular Earth parking orbit, the spacecraft has an orbit speed of 


=e (12.79) 


TO 


The burn Avo at to to enter the departure hyperbolic orbit is computed using 


Avy = — Ve = 1/22 +2 -— (12.80) 


As the parking orbit radius rg becomes smaller, then the corresponding circular 
orbit velocity v. becomes larger. If ro is sufficiently small such that vy. >> 1, 
then the departure burn Avy can be approximated as 


Avo © Ve (12.81) 


The point at which the Avo burn must be applied is defined through the 
angle ®. Since the spacecraft velocity must asymptotically align itself with the 
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Earth heliocentric velocity vector , this burn angle ©® is the hyperbolic asymptote 
slope angle ¢ computed in Eq. (8.24). Note that the magnitude of this angle is 
computed differently for burns sending spacecraft to outer planets versus burns 
sending craft to inner planets. For transfers to inner planets, the burn angle ® 
is defined as 


e 


® =cos! (<) (12.82) 


For transfers to outer planets, the burn angle ® must have a phase angle 7 
added to it. 


& = cos! (=) +1 (12.83) 
Eq. (12.82) corresponds to launching ”in the evening” so that we exit out the 
” back door” of the Earth’s sphere of influence. Whereas Eq. (12.83) corresponds 
to launching ”in the morning” so that we exit out of the front door” of the 
Earth’s sphere of influence (see Figure 12.17). 

Note that the hyperbolic eccentricity e has a value greater than 1. Further, 
note that the spacecraft hyperbolic injection point does not have to be in the 
Earth orbit plane about the Sun as illustrated in Figure 12.17. Let the angle 
® describe a cone about the Earth heliocentric velocity vector as illustrated in 
Figure 12.18. The craft can be in a general Earth orbit initially, as long as 
its trajectory intersects this cone. With each hyperbolic departure orbit, the 
spacecraft is initially in a circular parking orbit before receiving a tangential 
burn as shown in Figure 12.17. As prescribed, the hyperbolic departure orbit 
achieves the required escape velocity 1, at the Earth’s sphere of influence with 
its direction being along either the positive or negative Earth velocity direction. 
The distance between the spacecraft and the Earth heliocentric velocity direc- 
tion is negligible here. With the patched-conic interplanetary orbit solution, 
this distance is minor compared to the large distance to the other planet. How- 
ever, to find a precise interplanetary transfer orbit using a numerical solution 
technique, this distance must be taken into consideration. 

Given the heliocentric departure velocity v1 required of the spacecraft to 
perform the interplanetary mission, Eq. (12.76) defines the semi-major axis 
of the hyperbolic departure orbit, while Eq. (12.78) defines the initial Earth 
relative velocity vo at the hyperbolic perigee. Lastly, to define the hyperbolic 
trajectory geometry, as well as compute the burn angle ®, we need to determine 
the departure orbit eccentricity. Using the definitions of angular momentum, as 
well as Eqs. (8.28) and (8.29), we are able to express h through 


h? = pep = wea(1 — e?) = per,(1+ e) (12.84) 


Since the injection burn point at to is the periapses of the departure orbit, note 
that ro = rp. The angular momentum can then be expressed as 


h? = v5 (12.85) 
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Figure 12.18: Three-Dimensional Illustration of the Departure Hyper- 
bolic Orbits 


Substituting Eq. (12.85) into Eq. (12.84), we are able to solve for the eccentricity 
e in terms of the initial hyperbolic orbit speed vo. 
rove 


e= oi) (12.86) 
Le 





Substituting Eq. (12.76) into Eq. (12.84), we can solve for e in terms of the 
escape velocity 11 that the spacecraft must have as it travels through the Earth’s 
sphere of influence. 

rovz 


e= a (12.87) 
Le 





Either formula can be used to compute the hyperbolic departure orbit eccen- 
tricity. 
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12.5.3. Enter the Target Planet’s Sphere of Influence 


After a long interplanetary transit phase of the mission, assume the spacecraft 
is entering the target planet’s sphere of influence. Figure 12.19 illustrates the 
arrival of the spacecraft as seen relative to the target planet. Assume the inter- 
planetary transfer orbit is a near minimum energy type orbit. If the spacecraft is 
traveling from Earth to an inner planet such as Venus, then the craft will arrive 
at the target planet at the perifocus of its heliocentric transfer orbit. Thus the 
heliocentric velocity of the spacecraft will be larger than the heliocentric orbit 
velocity of the planet. To let the craft be captured by the planet, we typically 
approach the planet through the ”back door”. We we were ahead of the planet, 
our large velocity would make us out run the planet and we would never enter 
its sphere of influence (see Figure 12.19(i)). If the spacecraft is traveling to an 
outer planet such as Mars, then the planet is reached at the apofocus of the 
heliocentric transfer orbit. Thus our velocity will be less than the planet’s orbit 
velocity and we must position ourselves ahead of it. This way the planet will 
overtake us and allow us to enter its sphere of influence (see Figure 12.19(ii)). 

Without loss of generality, let us assume that the spacecraft travels from 
Earth to Venus. Further, the planets orbits are once again assumed to be cir- 
cular. To find the heliocentric arrival velocity vg, need to know the departure 
planet heliocentric orbit radius rg and the heliocentric departure velocity v1. 
Using the vis-viva equation in Eq. (8.82) and given the target planet’s heliocen- 
tric orbit radius ro, the arrival velocity v2 is expressed as: 


| 1 1 


To compute the spacecraft heading angle 2 relative to the Sun normal direction, 
we recall the definition of the angular momentum vector h. 


h=rxv (12.89) 


Assuming that the interplanetary mission began with a minimum energy burn 
along the Earth velocity vector, then h = rgv;. Here planets sphere of influence 
radius is considered to be much smaller than the planetary heliocentric orbit 
radius. The angular momentum of the spacecraft as it reaches Venus’ sphere of 
influence is then expressed as 


h = |re X ve| = re: v2 -sin(90° — a2) = reve cos a2 (12.90) 


Using Eq. (12.90), the heading angle 2 is written as 
h 
a2 =cos' ( ) (12.91) 


TQvV2 





To compute the Venus relative velocity vector vg of the spacecraft as it 
enters the planet’s sphere of influence, the Venus heliocentric velocity vg must 
be subtracted from the heliocentric velocity v2 of the craft. 


V2 = V2 — UE (12.92) 
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(ii) Arrival Orbit to the Outer Planet Mars 


Figure 12.19: Hyperbolic Arrival Orbit Illustration as seen by the Tar- 
get Planet 
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Using the law of cosines, we can compute the magnitude of nuzg through 


Vz = \/v3 + v8 — v2QUQ Cos a2 (12.93) 


The heading angle y2 between the velocity vectors v2 and v2 is found using the 
law of sines. 


2 = sin“! (2 sin a2) (12.94) 
V2 


The velocity v2 is the velocity of the spacecraft relative to the target planet 
as it enters the sphere of influence. Using the energy equation, we can express 
the semi-major axis of the approach trajectory through 

1 2 ve 
Sa te (12.95) 
a 12 pQ 


Assuming that the approach trajectory is a hyperbolic orbit, which is typically 
the case, we can set rg — oo and approximate a as 


a=—-+= (12.96) 


In order to achieve a final orbit about the target planet, it is obviously 
important that the spacecraft is not aimed directly at the target planet. Instead, 
it’s heliocentric trajectory is designed such that it will miss the target planet 
by a certain miss-distance d,,. This distance is measured along the planets 
heliocentric orbit path as shown in Figure 12.20. The illustrations used in this 
discussion all assume the spacecraft is going to approach the target planet from 
behind (as seen by the planets heliocentric velocity direction). It is also possible 
for the spacecraft to be aimed to intercept the target planets trajectory ahead 
of the planet. However, the resulting orbit about the target planet will have the 
opposite direction. To compute the shortest distance d, between the hyperbolic 
approach asymptote and the target planet we use 


da = dm sin(y2 + 02) (12.97) 


The hyperbolic asymptote angle ® is determined through 


& = cos! (=) (12.98) 


e 


To determine the hyperbolic eccentricity, we investigate again the constant 
spacecraft’s angular momentum relative to the target planet. As the space- 
craft enters the sphere of influence, the momentum h is given by 


h= \re x V2| = daV2 (12.99) 
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Figure 12.20: Illustration of the Asymptotic Approach Distance and 
Planet Miss-Distance 


Substituting Eqs. (12.96) and (12.99) into Eq. (12.84), the hyperbolic eccentric- 
ity e is expressed as 


2 5,2 
de V2 


e=,4/l+ 
HS 


(12.100) 


The periapses radius rp, is determined by substituting the semi-major axis a 
definition in Eq. (12.96) into the angular momentum expression in Eq. (12.84). 


Lt 
rp = a (e-1) (12.101) 


The orbit mission is typically designed such that the periapses radius ry is also 
the desired circular orbit radius about the target planet. This state is controlled 
both by the approach speed v2 and the eccentricity e of the hyperbolic approach 
orbit. Since e depends on the miss-distance d,,, the periapses radius can be set 
by aiming the spacecraft an appropriate distance ahead or behind the planet. 
Assume we wish to have a final circular parking orbit of radius r3 about the 
target planet, where r3 is also the periapses radius r, of the hyperbolic approach 
orbit. Let time tz be the point where the approach trajectory touches this 
desired parking orbit. Using the energy equation, we can express the spacecraft 
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velocity v3 at that instance. 


pe Se ge (12.102) 
T3 


The impulsive orbit correction required at perigee to circularize the orbit about 
the target planet is 


Av3 = Ve — V3 (12.103) 


where the circular orbit speed v, is given by 


ie a (12.104) 
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Figure 12.21: Illustration of Using a Staged Injection Burn with Elliptic 
Intermediate Orbits 


Depending on the incoming hyperbolic velocity magnitude, the Avs; com- 
puted in Eq. (12.103) may cause excessive deceleration forces on the crew and 
spacecraft structure. Also, it is possible that the spacecraft engines cannot pro- 
duce a large enough Av over the short burning time. What is commonly done 
is to achieve the desired orbit about the target planet through several stages 
of Av burns. During the first periapses passage, a large enough Av is applied 
to change the target planet relative orbit from being hyperbolic to being ellip- 
tic. As the spacecraft revisits the periapses, additional burns are performed to 
gradually reduce the semi-major axis of the elliptic orbit to the desired value. 
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This concept is illustrated in Figure 12.21. Through this sequential adjustment 
approach, the deceleration forces can be kept smaller to be achievable by the 
trusters and, possibly, to be bearable to crew and spacecraft structure. Note 
that in order to use the patched-conic orbits to compute Av requirements, it is 
important that the staging ellipses remain well within the sphere of influence 
of the target planet. Otherwise we can no longer assume Keplerian two-body 
motion. Instead, the complete influence of both the target planet and the Sun 
must be taking into account in a numerical simulation. 

Instead of performing thrusting maneuvers to decelerate the spacecraft, it is 
also possible to use the target atmosphere (if present) to decelerate the space- 
craft. Such maneuvers are referred to as aerobraking maneuvers. Their effec- 
tiveness depends on the approach speed and mass of the spacecraft. If the either 
is too high, than the atmosphere may not be able to slow down the spacecraft 
sufficiently to achieve an elliptic orbit and the craft will exit the planets sphere of 
influence. Structural heating and stress restrictions dictate how low a spacecraft 
can dip into an atmosphere to slow down. 


12.5.4 Planetary Fly-By’s 


All interplanetary orbits discussed so far had the spacecraft travel directly from 
the departure planet to the target planet. Due to the sphere’s of influence con- 
cept, the gravitational attraction of the other solar system planets was ignored. 
This greatly simplified the initial mission analysis and allowed to predict some 
basic Av estimates. 

However, omitting the gravitational influence of other planets excludes a 
very attractive type of interplanetary transfer orbit. It is possible to make 
use of other planets’ gravitational attraction to accelerate or decelerate the 
spacecraft relative to the Sun. Since several of these planets are quite massive 
(e.g. Jupiter), the favorable orbit perturbations can be large indeed. As the 
spacecraft approaches a planet, it will be slung around the planet and leave 
with a different heliocentric velocity direction and magnitude. This type of 
orbit maneuver is called a planetary fly-by and is illustrated in Figure 12.22. 
Instead of having a clean point-to-point interplanetary mission, the spacecraft 
is sent on a game of cosmic pinball. The major benefit of a planetary fly-by is 
that the spacecraft can be accelerated to reach a target planet faster without 
requiring more Av’s. The velocity direction changes are especially important, 
but the magnitude of the velocity can also be favorably affected. For example, 
to reach Mars it is possible to use Venus to sling-shot around and reach Mars 
in a much shorter period of time than what is typically possible for a given Av 
and a direct interplanetary approach. Also, for a deep space probe to reach the 
outer solar system planets, it is common to have them fly by Jupiter first to 
receive an extra boost to their heliocentric velocity. 

Assuming that the spacecraft is approaching a planet with a hyperbolic 
speed, it should be clear that having the craft sling around the planet should 
naturally change the velocity vector direction without having to fire any boost- 
ers. What may not be clear at first glance is why would this also change the 
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Figure 12.22: Illustration of a Sample Planetary Fly-By Maneuver 
about Venus 


magnitude of the velocity vector. Figure 12.22 illustrates how a planetary fly- 
by would be seen by the moving planet. Let us use the same notation as was 
used developing the hyperbolic approach trajectories to a target planet. As the 
spacecraft as it enters the planets sphere of influence, its heliocentric velocity 
is given by vg. The planet relative velocity vector is vg = ve — vg. Studying 
Keplerian two-body motion, we know that the velocity v2 with which the space- 
craft approach the planet will also be the asymptotic velocity that the craft will 
approach as it leaves the planet on a hyperbolic orbit. The question is, how is 
the spacecraft being accelerate or decelerate here? The key observation to make 
here is that for interplanetary missions, we are concerned with the heliocentric 
velocity of a spacecraft v;, not with the velocity 1; relative to some planet. 
As the craft departs the planets sphere of influence, it’s planet relative velocity 
vz will have the same magnitude as the approach velocity vector v2. The two 
velocity vectors v; will only differ in their direction. Thus we have 


V3 x V2 V3=12 (12.105) 


The spacecraft’s heliocentric velocity as it departs the planet’s sphere of influ- 
ence is given by 


v3 = V3 + VO (12.106) 
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Depending on the angle between the planetary heliocentric velocity vector and 
the flight angle of the spacecraft, the velocity v3 can either have a larger or 
smaller magnitude than v2. The illustration in Figure 12.22 shows a case where 
the planet is approached from behind (as seen relative to the planet’s heliocentric 
velocity vector). This type of approach will result in the spacecraft picking up 
some heliocentric speed. If the craft approaches the planet from the front and 
departs rearward, then the craft would loose some heliocentric speed. 

How to compute the incoming spacecraft heading angles o2 and Yo, as well 
as the hyperbolic asymptote angle ®, have already been shown in section 12.5.3. 
For notational convenience, let us define 6; to be 


0, = Pit oi (12.107) 


Studying Figure 12.22, the angle 63 describes the planet relative departure ve- 
locity vector v3 direction relative to the planet’s heliocentric velocity vector and 
is found to be 


63 = 180° — 26 — 6, (12.108) 


Using the law of cosines, the heliocentric velocity magnitude v3 is expressed as 


U3 = 4/V3 + vB + 229 cos 3 (12.109) 


Using the law of sines, the angle y3 between the planet relative and the Sun 
relative velocity vectors is given by 


3 = sin7! (sin on) (12.110) 
U3 


Thus, the direction angle o3 of the spacecraft’s heliocentric departure velocity 
vector is computed using 


03 = 63 — 3 (12.111) 


The heliocentric angular momentum of the spacecraft as it enters the planets 
sphere of influence is 


h(t2) = reve cos aa (12.112) 


As the spacecraft exits the sphere of influence, it’s angular momentum about 
the Sun is given by 


h(ts) = TQV3 COS 03 (12.113) 


Note that the planet’s sphere of influence radius is assumed to be much smaller 
than the planet’s heliocentric orbit radius. As the spacecraft accelerates or decel- 
erates during the fly-by maneuver, it does so by exchanging angular momentum 
with the planet. Thus we find that momentum change Ah to be 


Ah = h(t3) — h(t2) #0 (12.114) 
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Since the total angular momentum of the solar system is constant, the planets 
change in angular momentum will be —Ah. While the planet will change its 
heliocentric orbit velocity during a fly-by, this effect can be ignored. The reason 
for this is the huge mass imbalance between the spacecraft and the planets. The 
change in the planetary orbit velocity is minuscule and has no practical effect 
on its trajectory. Let us define m to be the spacecraft mass and v to be the 
spacecraft velocity component normal to the heliocentric orbit radius. The total 
angular momentum H of both Venus and the spacecraft about the Sun is given 
by 


H =moreve + mrov (12.115) 


Again we make the simplifying assumption that the planets sphere of influ- 
ence radius is negligible compared to the heliocentric orbit radius. During the 
planetary fly-by, the total change in angular momentum must be zero. 


AH =0= moeroAve + mreAv (12.116) 


Thus, for a given spacecraft velocity change Av, the corresponding change in 
the planet’s heliocentric velocity is 


Avo = ——Av GOT) 
mg 
Since m/mg — 0, the change in the planets velocity can be ignored for planetary 
fly-by maneuvers. 


Problems 


12.1 Assume a spacecraft is to enter an interplanetary mission to either Mars, Venus 
or Jupiter and requires an initial heliocentric departure velocity v1 from the Earth 
sphere of influence. Compute the sensitivities of errors in the initial hyperbolic 
injection burn Avo if the parking orbit is at an altitude of 250 km. Perform this 
calculation for each of the three planets and comment on the values. 
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CHAPTER THIRTEEN 


Spacecraft Formation 
Flying 





Spacecraft formation flying concepts have been studied since the beginning of the 
manned space program. The challenge at that time was to have two-spacecraft 
rendez-vous and dock onto each other. This was particularly crucial for the 
Apollo space program which had the final lunar spacecraft being assembled 
in orbit. During this maneuver orbit corrections are performed not to correct 
the Earth relative orbit itself, but rather to adjust and control the relative 
orbit between two vehicles. For the docking maneuver, the relative distance is 
decreased to zero in a very slow and controlled manner. 

The modern day focus of spacecraft formation flying has now extended to 
maintain a formation of various spacecraft. For example, the U.S. Air Force is 
studying concepts of having a cluster of identical satellites form a sparse aper- 
ture radar dish in space. Having multiple satellites flying at a specific geometry 
avoids the significant technical and financial challenge of attempting to build 
a radar dish of the equivalent size. These satellite formations can have diame- 
ters ranging from several dozens of meters to several kilometers. Attempting to 
build, control and navigate a light-weight radar dish structure that could span 
several kilometers would be very challenging and not cost effective. Instead, 
having a multitude of satellites form a virtual radar dish has the advantage of 
avoiding the structural flexing issues of the large dish structure and the associ- 
ated pointing difficulties. 

A conceptual difference between the formation flying problems that result 
in two or more vehicles docking and the spacecraft formation flying problem of 
maintaining the relative orbit of a cluster of satellites is that the later is signifi- 
cantly more sensitive to relative orbit modeling errors. If the satellites involved 
are being navigated to a rendez-vous, then the formation flying period of the 
two vehicles is relatively limited compared to the lifetime of the vehicle itself. 
Typically, the rendez-vous and docking maneuvers occur over 1-2 orbits. Thus, 
from a control perspective, if the relative orbit description contains some minor 


ATT 
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simplifying assumptions, then this will have a minimal impact on the control 
performance. The feedback control laws are robust enough to compensate for 
such modeling errors and will guide the spacecraft involved to a safe docking. 
Also, as the two vehicles approach each other, the relative distance becomes 
smaller and smaller. Thus any errors introduced into the relative motion de- 
scription by making linearizing assumptions become negligible during the final 
docking phase. 


However, for the task of maintaining a spacecraft relative orbit formation, 
where a cluster of satellites are supposed to continuously orbit each other, mak- 
ing linearizing assumption can potentially lead to a substantially higher fuel 
cost. The reason is that this formation is supposed to be maintained over the 
entire life span of the satellites. If a relative orbit is designed using a very sim- 
plified orbit model, then the formation station keeping control law will need to 
continuously compensate for these modeling errors and burn fuel. Depending 
on the severity of the modeling errors, this fuel consumption could drastically 
reduce the lifetime of the spacecraft formation. It is precisely this sensitivity 
to the orbital dynamics that makes this type of formation flying problem very 
interesting from the celestial mechanics point of view. 


There are two types of spacecraft formations that are being considered here. 
One case has the satellite cluster consisting of spacecraft of different type and 
built. This results in each craft having a different ballistic coefficient. Thus, 
the orbit of each vehicle will decay at a different rate due to the drag difference 
between the orbits. The main challenge for the station keeping control law 
of such spacecraft formations is to assure that all the orbits of each satellite 
decay on average at an equal rate. While this is a challenging control task, it is 
not that interesting from a dynamics or celestial mechanics point of view since 
these uncontrolled relative orbits are not closed relative orbits (i.e. they don’t 
repeat each orbit). The second type of spacecraft formations consist of a cluster 
of satellites of equal type and built. Here each satellite ideally has the same 
ballistic coefficient. Thus each orbit will decay nominally at the same rate. For 
this case it is possible to analytically find closed relative orbits. These relative 
orbits describe a fixed geometry as seen by the rotating spacecraft reference 
frame. This frame will be defined more carefully in the next section. 


This chapter develops the relative orbit descriptions of two or more satellites 
for both circular and elliptic reference orbits. All satellite constellations are 
assumed to be comprised of spacecraft of equal type and built. Thus, the relative 
drag effect will only have a secondary effect on the relative orbit. The dominant 
dynamical effect studied in this chapter will be the gravitational attraction of 
the planet. In particular, the effect of both a spherical or oblate body are 
considered. Finally, some relative orbit control laws will be presented that are 
able to establish and maintain a desired relative orbit among the spacecraft. 
While the relative orbit equations of motion developed here could be used to 
develop rendez-vous or docking control laws, this type of spacecraft formation 
flying is not specifically discussed in this paper. An excellent survey of the 
spacecraft rendez-vous problem is provided by Carter in Reference 1. 
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13.1 General Relative Orbit Description 


This section develops the relative orbit equations of motion and presents meth- 
ods to establish closed relative orbits. Both the Cartesian coordinates and the 
orbit element description will be used. The spacecraft formation flying nomen- 
clature used in this chapter is as follows. The simplest type of spacecraft for- 
mation flying geometry is the leader-follower type of formation flying shown in 
Figure 13.1. Here the two spacecraft are essentially in identical orbits, but are 
separated only by having different anomalies. If this orbit is circular, then the 
spacecraft separation will remained fixed since both vehicles are always moving 
at the same orbital speed. If the orbit is elliptical, then the spacecraft separation 
will contract and expand, depending on whether the formation is approaching 
the orbit apoapses or periapses. 
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Figure 13.1: Illustration of a Leader-Follower Type of a Two-Spacecraft 
Formation 


The satellite about which all other satellites are orbiting is referred to as 
the chief satellite. The remaining satellites, referred to as the deputy satellites, 
are to fly in formation with the chief. Note that it is not necessary that the 
chief position actually be occupied by a physical satellite. Sometimes this chief 
position is simply used as an orbiting reference point about which the deputy 
satellites orbit. 

The inertial chief position is expressed through the vector r.(t), while the 
deputy satellite position is given by rq(t). To express how the relative orbit 
geometry is seen by the chief, we introduce the Hill coordinate frame.? Its origin 
is at the chief satellite position and its orientation is given by the vector triad 
{6,, 69, 6,} shown in Figures 13.1 and 13.2. The vector 6, is in the orbit radius 
direction, while 6;, is parallel to the orbit momentum vector in the orbit normal 
direction. The vector 6g then completes the right-handed coordinates system. 
Mathematically, these O frame orientation vectors are expressed as 


Te 
eg gt 

6 - (13.1a) 
06 = On, x Oy, (13.1b) 


(13. 1c) 


> > 
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withh = r,.xr,. Note that if the inertial chief orbit is circular, then dg is parallel 
to the satellite velocity vector. This rotating reference frame is sometimes also 
referred to as the Hill frame. 








Chief Inertial Orbit 


Figure 13.2: Illustration of a General Type of Spacecraft Formation with 
Out-Of-Orbit Plane Relative Motion 


A dynamically more challenging type of general spacecraft formation flying 
than the leader-follower type is shown in Figure 13.2. The relative orbit position 
vector p is expressed in O frame components as 


p= (2,y,2z)" (13.2) 


Here the various spacecraft are on slightly different orbits that will satisfy some 
specific constraints. These constraints ensure that the relative orbit is bounded 
and that the spacecraft will not drift apart. With these types of orbit, the chief 
satellite (or chief position) is the relative orbit interior point about which all 
the other deputy satellites are orbiting. 


13.2 Cartesian Coordinate Description 


In this section we chose to describe the relative orbit in terms of the Cartesian 
coordinate vector p = (a, y, z)’. The vector components are taken in the rotat- 
ing chief Hill frame. The advantage of using Hill frame coordinates is that the 
physical relative orbit dimensions are immediately apparent from these coordi- 
nates. The (x,y) coordinates define the relative orbit motion in the chief orbit 
plane. The z coordinate defines any motion out of the chief orbit plane. 
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13.2.1 Clohessy-Wiltshire Equations 


To derive the relative equations of motion using Cartesian coordinates in the 
rotating Hill frame, we write the deputy satellite position vector as 


Ta =Te+ p= (re + 2)6, + yOo + 26p, (13.3) 


where r, is the current orbit radius of the chief satellite. The angular velocity 
vector of the rotating Hill frame O frame relative to the inertial VV frame is 
given by 


Won = fan (13.4) 


with f being the chief frame true anomaly. Taking two derivatives with respect 
to the inertial frame, the deputy satellite acceleration vector is given by 


#a= (e+ 4-2 — fy- P(ret+a)) 6, 
+ (G+ 2f('0+¢) + Fre +2) — fPy) bo + 26n (13.5) 
This kinematic expression can be simplified by making use of the following 
identities. The chief orbit angular momentum magnitude is given by h = r?f. 
Since h is constant for Keplerian motion, taking the first time derivative of h 
yields 
h=0=2reroftr2f (13.6) 


This orbit element constraint can be used to solve for the true anomaly accel- 
eration. 


f= -2% j (13.7) 


Further, we write the chief satellite position as r, = r.6,. Taking two time 
derivatives with respect to the inertial frame and using the orbit equations of 
motion, the chief acceleration vector is expressed as 


To = G = ref?) Or a —5r. = - 56, (13.8) 


Cc 


Equating vector components in Eq. (13.8), the chief orbit radius acceleration is 
expressed as: 


ro= oe o 5 = ref (1 _ a) (13.9) 


c 


Substituting Eqs. (13.7) and (13.9) into Eq. (13.5), the deputy acceleration 
vector expression is reduced to 


o oe rs . Te p LL A 
fa = (2-27 (i-v=) -2f- 5) Or 


+ € +2f (: = ot) = uf?) 66+ Z6n (13.10) 


Cc 
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Next, we substitute the kinematic acceleration expression in Eq. (13.10) into 
the orbit equations of motion. The deputy satellite orbital equations of motion 
are given by 


ll Te +X 
Tqg=—-zalMa=-Z y (13.11) 
"a "a z 


with rg = (re +2)? +y? + 22. Equating Eqs. (13.10) and (13.11), the exact 
nonlinear relative equations of motion are given by 





¢—2f € y=) af?-£ =-fo.+a) (13.12a) 
Te Te Tr 

+2 (¢- 0%) —yf? =—-4y (13.12b) 
To rs 

g=-4. (13.12c) 
d 


The only assumption which has been made is that no disturbances are acting 
on the satellites and thus the Keplerian motion assumption in the orbital equa- 
tions of motion in Eq. (13.11) are correct. The relative equations of motion in 
Eq. (13.12) are valid for arbitrarily large relative orbits and the chief orbit may 
be eccentric. If the relative orbit coordinates (x, y, z) are small compared to the 
chief orbit radius r., then Eq. (13.12) can be further simplified. The deputy 
orbit radius rg is approximated as 


2 2 2 
Sag EE es ae (13.13) 
Tec TS Te 


This allows us to write 
Lape a (1 3) (13.14) 
The term p/r? can also be written in the following useful forms: 


Le "oe p2 i a 
=f? = —__- 13.15 
r3 f 1+ ecos f ( ) 
Note that the orbit elements shown in Eq. (13.15) are chief orbit elements. 
Neglecting higher order terms, we are able to simplify the right hand side of 
Eq. (13.11) to 


a (tet r P ln. +a yn (te 72 
= x >{1-3—-— as 13.16 
"3 y al =) y a y (13.16) 


z z 
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Substituting Eq. (13.16) into Eq. (13.12) and simplifying the resulting expres- 
sions yields the relative orbit equations of motion assuming that z, y, z are small 
compared to chief orbit radius r¢. 


& — af? (+24) oF (s-v=) =0 (13.17a) 
j+2i(a—0) a? (1-%)=0 (13.17b) 
e+ 2722-0 (13.17c) 

Pp 


Using Eqs. (13.7) and (13.15), along with the true latitude 0 = w+ f, the general 
relative equations of motion are rewritten in the common form:® 


é— 2 (# +24) — y§ — 240 =0 (13.18a) 
re 
ij +26 +2646 —y (#- 5) =0 (13.18b) 
Te 
is LL 
Z+ Fae =0 (13.18c) 


If the chief satellite orbit is assumed to be circular, then e = 0, p= r-, and 
the chief orbit radius r, is constant. Since for a circular orbit the mean orbital 
rate n is equal to the true anomaly rate f, the relative equations of motion 


reduce to the simple form known as the Clohessy- Wiltshire (CW) equations.” 4 
#% — 2ny — 3n?xz = 0 (13.19a) 

y+ 2nz = 0 (13.19b) 

Z4+n?z=0 (13.19c) 


Note that these equations of motion are only valid if the chief orbit is circu- 
lar and the relative orbit coordinates (x,y,z) are small compared to the chief 
orbit radius r,. The simple form of the differential equations in Eq. (13.19) 
allows them to be analytically integrated to find closed form solutions to the 
relative equations of motion. For example, the differential equations of motion 
for the relative orbit out-of-plane motion, shown in Eq. (13.17c), is that of a 
simple spring-mass system which has a known solution. This development of 
the analytic relative equations of motion solution is shown in the section 13.2.2. 

The general relative equations of motion, shown in Eq. (13.17), take on a 
very elegant form if written in a non-dimensional form. Let us define the non- 
dimensional relative orbit coordinates (u,v, w) as 


(13.20) 
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Instead of differentiating with respect to time, we now differentiate with respect 
to the chief orbit true anomaly f. This type of differentiation is written here as 


d() 
ja ND 13.21 
("=o (13.21) 
To obtain the non-dimensional relative equations of motion, the following iden- 
tities relating time derivatives of (x,y,z) coordinates to corresponding non- 
dimensional derivatives of (u,v, w) will be used: 








Fay fra * aul ft uf? (1 2 a) (13.22) 
Tec To Tec Pp 
Sih Pe J Ly" frp uf? (1 - ‘) (13.22b) 
Tc To Tec Pp 
*=wfiw = aw" f? + wf? (1- a) (13.22c) 
Tec Te Te Pp 


Dividing the dimensional equations of motion in Eq. (13.17) by the chief orbit 
radius r,, substituting the identities in Eq. (13.22) and simplifying leads to the 
following elegant non-dimensional relative equations of motion: 


(pia 2G (13.23a) 
1+ ecos f 

vu! +2u’ =0 (13.23b) 

w'+w=0 (13.23c) 


The above relative equations of motion are valid for eccentric chief orbits, as 
long as (u,v,w) < 1. Comparing Eq. (13.19) to Eq. (13.23), it is clear that 
the form of the non-dimensional equations of motion is very close to that of the 
Clohessy- Wiltshire equations. The only algebraic difference is the additional 
fraction in the non-dimensional radial equations of motion in Eq. (13.23a). 


13.2.2 Closed Relative Orbits in the Hill Reference Frame 


Starting with the Clohessy- Wiltshire equations in Eq. (13.19), we would like to 
find constraints for the relative orbit coordinates (x,y,z) which will guarantee 
that the relative orbit geometry will remain bounded. The underlying assump- 
tion here is that the chief orbit is circular and perturbations to the Keplerian 
motion can be ignored. The relative equations of motion in terms of (2, y, z) 
are repeated here for convenience: 


# — 2ny — 3n?x2 =0 (13.24a) 
y+ 2nz =0 (13.24b) 
z+n?z=0 (13.24c) 


The z component decouples here from the radial and along track directions 
and has the form of a simple un-forced oscillator differential equation. It’s 
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general solution is given by 
z(t) = Bo cos(nt + £) (13.25) 


where Bo and (@ are integration constants which are determined through the 
initial conditions. Further, Eq. (13.24b) is of a perfect integrable form leading 
to 


y= —2nae+d (13.26) 


where the integration constant d = yo + 2nxo is defined through the initial 
conditions. Substituting Eq. (13.26) into Eq. (13.24a), the equation of motion 
in the x direction is written as the forced oscillator differential equation 


#+n?a = 2nd (13.27) 


Solving this differential equation, the radial position component is given by 


2 
x(t) = Ap cos(nt + a) + a (13.28) 
n 


where Ap and a are determined through the initial conditions. Defining the 
scalar offset in the orbit radial direction as 


2d 
a 13.29 
the x(t) equation can be written as 
x(t) = Ao cos(nt + a) + off (13.30) 


Substituting Eq. (13.28) into Eq. (13.26), the first order differential equation 
for y(t) is written as 


y = —2nAp cos(nt + a) — 3d (13.31) 


Integrating this differential equation and using yor f as the integration constant, 
y(t) is written as 


y(t) = —2Apsin(nt + a) — 3dt + yor f (13.32) 


Thus the analytical solution to the CW equations in Hill frame components is 
summarized as 


x(t) = Ag cos(nt + a) + Lor f (13.33a) 
y(t) = —2Apsin(nt + a) — Stor + Yos f (13.33b) 
z(t) = Bo cos(nt + £3) (13.33c) 


Note the the expression for y(t) contains a secular term which will grow infinitely 
large as t — oo. All other terms in Eq. (13.33) are either sin or cos functions, 
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or a constant offset. Thus, to avoid the secular growth in y(t) we must set of f 
equal to zero. This is equivalent to setting the integration constant d, defined in 
Eq. (13.29), equal to zero. The bounded relative orbit constraint for a circular 
chief orbit is given in terms of Hill frame coordinates as: 


d= Yo + 2nay = 0 (13.34) 


Note that this requirement is identical to assuring that x ¢r = 0. The analytical 
solutions for bounded solutions of the CW equations are then given by 


x(t) = Ap cos(nt + a) (13.35a) 
y(t) = —2Apsin(nt + a) + Yor f (13.35b) 
z(t) = Bo cos(nt + (3) (13.35c) 





Example 13.1: For the sparse aperture type of spacecraft formation mission, 
the sensor requirements specify that the (y, z) projection of the relative orbit 
be circular. Studying Eq. (13.35), the (y,z) trajectory will only describe 
a circle if the along track offset yor is to zero. Further, the along track 
sinusoidal amplitude Ao and the out-of-plane sinusoidal amplitude Bo must 
satisfy 


Bo = 2Ao 


Note that the projection of the relative orbit onto the (x,y) plane always 
forms an ellipse which is twice as large in the along track direction than in 
the radial direction. Further, the phase angles a and (3 must satisfy 


a=, or a = 3+ 180° 


Adding 180 degrees to the phase angle difference makes the relative orbit 
have a different relative inclination. This is illustrated in Figure 13.3. Both 
relative orbits are computed using Ao = 0.5 km, Bo = 1.0 km and a = 0 
degrees. 

Therefore, assuming Bo = 2Ao and a = @, then the relative orbit trajectories 
of interest are given in Hill frame vector components by 


cos(nt + a) 
= Ao | —2sin(nt + a) 
2 cos(nt + a) 


p= 


rxRes 


with the local velocity as seen in the Hill frame being 








oO x sin(nt + a) 
dp) = | y | =—Aon | 2cos(nt + a) 
dt 

Zz 2 sin(nt + a) 


To map the relative vectors p and p back to inertial position and velocity 
vectors of the deputy satellite, it is assumed that the inertial position and 
velocity vectors of the chief are given. Using the Hill frame orientation vectors 
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Figure 13.3: Relative Orbit Comparison in the Hill Reference Frame for 
Different Phase Angle Differences 


defined in Eq. (13.1), the direction cosine matrix which relates inertial frame 
vector components to Hill frame components is computed through 
aT 
[ON] = | of 
on, 


The inertial deputy position vector rq is then computed as 


ra =Te+[ON]' p 


where it is assumed that r, is given in inertial components. The inertial 
deputy satellite velocity is found through 


oO 
ra =. + [ON]? je Hip, x p) 


13.3. Orbit Element Difference Description 


While using the Hill frame coordinates (2, y, z) is a common method to describe 
a relative orbit, they have the distinct disadvantage that their differential equa- 
tions must be solved in order to obtain the relative orbit geometry. The relative 
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orbit is determined through the chief orbit motion and the relative orbit initial 
conditions 


X= (x0, Yo, 20, £0, Yo, 40) (13.36) 


To find out where a deputy satellite would be at time t, the appropriate dif- 
ferential equations in either Eq. (13.17) or Eq. (13.19) need to be integrated 
forward to time t. Thus, the six initial conditions in Eq. (13.36) form six invari- 
ant quantities of the relative orbit motion. However, they are not convenient to 
determine the instantaneous geometry of the relative orbit motion. However, 
if the chief orbit is circular, then the elegant CW equations have an analytical 
solution shown in Eq. (13.35). This lead to the initial condition constraint in 
Eq. (13.34) which guarantees bounded relative motion. However, this constraint 
is only valid if the relative orbit dimension is small compared to the chief or- 
bit radius (linearizing assumptions are valid), and if the chief orbit is circular 
(e > 0). 

Instead of using the six relative orbit invariants shown in Eq. (13.36) to 
define the relative orbit and obtain a bounded relative orbit constraint, we 
would like to investigate other relative orbit invariant parameters that would 
yield equivalent results without the need for the linearizing assumptions and 
near-circular chief orbit requirements. 

To do this, we first review how the inertial orbits are described and solved 
for in a Keplerian two-body system. Let r be the inertial position vector of a 
spacecraft about a spherical planet, then the differential equations to be solved 
are given by 

_ -4r (13.37) 
with the initial conditions being r(to) = ro and r(to) = ro. These six initial 
conditions form the six invariant parameter of this dynamical system. However, 
as is shown in Chapter 8, the Keplerian motion of a satellite can also be defined 
through six orbit elements. For example, let us define the orbit element vector 
e to contain the parameters 


e = (a,€,1,0,w, Mo)? (13.38) 


where a is the semi-major axis, e is the eccentricity, 7 is the orbit inclination 
angle, Q is the longitude of the ascending Node, w is the argument of the 
pericenter and Mo is the initial mean anomaly. Instead of solving a differential 
equation to find the current satellite states, the algebraic Kepler’s equation must 
be numerically solved to find the current mean anomaly angle. Thus there is 
essentially only one state M that must be solved to find the satellite position. 
Compare this to using the X state vector. Here all six states are fast variables, 
meaning that they vary throughout the orbit. Using the orbit elements thus 
simplifies the orbit description and the satellite position computation. Further, 
note that even with disturbances present such as gravitational perturbations or 
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atmospheric or solar drag, these orbit elements will only change slowly. This is 
illustrated in Chapter 11. 

Assuming for now that no disturbances are present, then the six orbit el- 
ements are invariant unless some control thrust is applied to the spacecraft. 
Instead of defining the relative orbit in terms of the six Hill frame coordinates 
in Eq. (13.36), let us propose to define the relative orbit in terms of the orbit 
element difference vector de 


de = €4 — €¢ = (6a, be, 5i, 6, bw, 5Mo)* (13.39) 


where eq is the deputy satellite orbit element vector and e, is the chief orbit 
element vector. Note that this relative orbit description using orbit element 
differences is not constraint to the particular orbit elements used here. Any 
complete set of orbit elements could be used. Given de and e,, the deputy 
satellite position can be computed at any instance of time by solving Kepler’s 
equation. As is the case with the inertial orbit description, we are able to avoid 
having to solve a differential equation. Note that the relative orbit description 
in Eq. (13.39) does not make any assumptions on how large the relative orbit 
is compared to the chief orbit radius, nor does it require that the chief orbit is 
circular. 

Working with orbit element differences also provides some insight into the 
orbit geometry itself. Simply starting out with the Hill frame initial conditions 
in Eq. (13.36), the relative orbit geometry is only determined after solving the 
differential equations. However, by describing the relative orbit in terms of 
orbit element differences, it is possible to make certain statements regarding 
the relative orbit geometry. This concept is illustrated in Figure 13.4. Both 
the inclination angle and ascending node differences will affect the magnitude 
of the out-of-plane motion of the relative orbit. The inclination angle difference 
di specifies how much out-of-plane motion the relative orbit will have as the 
the satellite cross the northern or southern most regions. The ascending node 
difference shown what the out-of-plane motion will be as the satellite crosses the 
equator. For example, if corresponding orbit element differences are computed 
for a given relative orbit and 67 is found to be zero, then it can immediately be 
concluded that the relative orbit will have zero out-of-plane motion as the chief 
passes the outer latitude extremes. 


13.3.1 Linear Mapping Between Hill Frame Coordinates and 
Orbit Element Differences 


To map between the X and ée relative orbit coordinates, the nonlinear mapping 
between inertial coordinates and orbit elements shown in Chapter 8 could be 
used. However, if the relative orbit is small compared to the chief orbit radius, 
then it is possible to obtain a direct linear mapping [A(e,)] between X and de. 


X = [A(e.)|5e (13.40) 
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maximum 





(i) Inclination Angle Difference (ii) Ascending Node Difference 


Figure 13.4: Relative Orbit Effect of Having Specific Orbit Element Dif- 
ferences 


To avoid some numerical difficulties for near circular orbits, let us use the orbit 
element vector e is defined through 


e= (a, 0, i, q1, 92,2)" (13.41) 


with @ being the true latitude angle (sum of argument of perigee and true 
anomaly), and q; and q2 being defined through 


qi = ecosw (13.42) 
gg = esinw (13.43) 


Let us define the following three coordinates systems. Let C and D be the Hill 
coordinate frames of the chief and deputy satellites, respectively, and let NV be 
the inertial frame. Then [CN] = [CN (Qe, ic, 9)] is the direction cosine matrix 
mapping vector components in the inertial frame to components in the chief 
Hill frame. To relate the orbit element difference vector de to the corresponding 
LVLH Cartesian coordinate vector X, we write the deputy spacecraft inertial 
position vector rq in chief and deputy Hill frame components as 


rg = "(re +2,y,2)" (13.44) 
Pra =P(ra,0,0)7 (13.45) 


where r is the inertial orbit radius. The deputy position vector rq is now 
mapped from the deputy Hill frame vector components to the chief Hill frame 
vector components using 


Cra = (CNIINDP] Pra (13.46) 
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To simplify the notation from here on, the subscript c is dropped and any 

parameter without a subscript is implied to be a chief orbit parameter. Taking 

the first variation of [VD] and rg about the chief satellite motion leads to the 
first-order approximations 

[ND] = [NC] + [NC] (13.47) 

raert+or (13.48) 


Eq. (13.46) is then expanded to yield 





r+ or 
Cra = ((I3x3] + [(CNI[SNC]) 0 (13.49) 
0 
Dropping second-order terms, the deputy position vector is written as 
r+ or ONC 
org = O | +r [CN] | 6NCa2i (13.50) 
0 INC31 
with the matrix components dC; given by 
ONC14 =NCi2 60 — NC2 6Q +NC31 sinQ 62 (13.51) 
ONC21 =NC22 60 +NCqy1 6Q — NC31 cos) 6% (13.52) 
ONC31 = NC39 60+ sin@cosi 6% (13.53) 


Substituting Eqs. (13.51) - (13.53) into Eq. (13.50), the deputy position vector 
is written in terms of orbit element differences as 


r+or 0 
Crg=| 0 J4r 60 + 6Q.cosi (13.54) 
0 — cos #sin76Q+ sin 067 


To be able to write Eq. (13.54) in terms of the desired orbit elements and their 
differences, the orbit radius r must be expressed in terms of the elements given 
in Eq. (13.41). 


a(1 — q? — 4g) 


OO  ———— 
1+ q1 cos? + q2siné 


(13.55) 
Thus, the variation of r is expressed as 


Vi, : 
br = —Sa + r 66 — 2 (2aq, + r-cos0)dq1 — —(2ag2 + rsin)5q. (13.56) 
a Vi Pp Pp 


where the chief radial and transverse velocity components V,. and V; are defined 
as 


=> 


V, =r = —(qi sin é — q2 cos 8) (13.57) 


3 
Pl 


Vi = 7rd = —(1+ 11 cos 6 + qsin§) (13.58) 


 —?p 
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with h being the chief orbit momentum magnitude and p being the semilatus 
rectum. Comparing the chief Hill frame components of the deputy position 
vector descriptions in Eqs. (13.44) and (13.54), the local Cartesian Hill frame 


coordinates x, y and z are expressed in terms of the orbit element differences 
5, 6 
>> 


a 
x= or (13.59a) 
y = 17(00 + cosi dQ) (13.59b) 
z=r(sin6@ 64 — cos@sini dQ) (13.59c) 


At this point half of the desired mappings between orbit element differences 
and the corresponding LVLH Cartesian coordinates have been developed. To 
derive the linear relationship between the orbit element differences and the 
Cartesian coordinate rates (“,y,2), a similar approach as has been used to 
derive Eqs. (13.59a) through (13.59c) could be used. In Reference 7, the deputy 
velocity vector is expressed in both the chief and deputy frame. The desired 
Cartesian coordinate rates are then extracted by comparing the two algebraic 
expressions. 

However, it is also possible to obtain the Cartesian coordinate rate ex- 
pressions in terms of orbit element differences by differentiating Eqs. (13.59a) 
through (13.59c) directly with respect to time. The only time-varying quanti- 
ties in these three expressions are the chief true latitude 6 and the difference 
between deputy and chief latitude 66. Only the latter quantity needs special 
consideration. Using the conservation of angular momentum h, we express the 
true latitude rate 6 as 


ao” (13.60) 


72 
The variation of Eq. (13.60) yields 


- Oh h 
Using the angular momentum expression h = ,/jp, the dh variation is expressed 
as 


h 
dh= ne (13.62) 
where dp is given by 
Sp = © 5a 2a(qdqn + 42642) (13.63) 


Thus the desired variation in the true latitude rate is expressed as 


66 = a (2 - 2m) (13.64) 
r2 \ 2p r 
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After differentiating Eqs. (13.59a)-(13.59c) and making use of Eq. (13.64), 


the Cartesian coordinate rates are expressed in terms of orbit element differences 
5, 6 


as 
V, 1 1 
& = ——0da+(- — -)hdd 
2a rp 
5 5 (13.65a) 
+ (V-aqi + hsin \ + (V,aq2 — hceos a 
3V; 6 
y= te — V,.60 + (3V;aq1 + 2h cos eens 
m ; e (13.65b) 
+ (3Viaqo + 2hsin 6)—2 + V,cosi 52 
Pp 
z= (Vi cos@ + V, sin 0)d¢ + (V; sin 0 — V, cos 8) sin 16Q (13.65c) 


Combined, Eqs. (13.59)and (13.65) define the linear mapping [A(e,)] from 
de to X relative orbit states. The inverse of the matrix [A(e)] is developed in an 
analogous manner.® To simplify the expressions, the following non-dimensional 
parameters are introduced 








a=a/r (13.66) 
p=r/p (13.68) 
1 
ky =a (- — i) (13.69) 
p 
gl 
ko = av*— (13.70) 
p 
The non-zero matrix elements of [A(e.)|~' are given by: 
Aj} = 2a(2 +341 + 2x2) (13.71a) 
Ajy = —2av(1 + 2m + x2) (13.71b) 
2a°vp 
Ay =—— 13.71 
14 V; ( 9) 
= 2a 
Aji = 7( + 2K + Ka) (13.71d) 
1 
Ay == 13.71 
22 ~ BR ( e) 
tj 
ASL = = (cos + vsin 8) (13.71) 
Saas 
Ax = —— (13.71g) 
Vi 
ind — ; 
Awe sin y cos 0 (13.71h) 


R 
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cos 0 
Axi = 13.71i 
36 = (13.71i) 
AZ = £(3cos6 + 2vsin 8) (13.71j) 
1 
Ag} = —% (ov? sind + qr sin 20 — qo cos 20) (13.71k) 
Me 
Ag = — B= (00s 6 + vsin 8) (13.711) 
ind 
As (13.71m) 
V; 
Ay = © (2cos6 + vsin 8) (13.71) 
t 
ey 
Arg = Bos (13.710) 
V; 
Az; = £(3sind — 21088) (13.71p) 
1 
Azz = a (pv cos 8 + qgsin 20 + q cos 26) (13.71q) 
As; = a (cos 8 + ysin 6) (13.711) 
= pcos 6 
Ag, = TG; (13.71s) 
ae = £(2sind — 10s 8) (13.71t) 
t 
oe 
Ages ee (13.710) 
Vi 
cos@ + vsind 
Ae eee 13.71 
ee Rsini aly) 
sin 0 
Ase = 13.71 
Be Vz sini tay) 


Similarly as was done with the relative equations of motion in terms of Hill 
frame Cartesian coordinates, it is possible to express the linear mapping [A(e,)] 
in terms of the non-dimensional coordinates (u,v,w) defined in Eq. (13.20). 
Often this non-dimensional form provides for more convenient algebraic ex- 
pressions.” ® ° Dividing Eq. (13.59) by the orbit radius r, the non-dimensional 
relative orbit coordinates (u,v, w) are expressed as: 


x 6a 
= ees pa 
ie 7 +V6 (2aqi + cos 0) pdqr (13.72a) 
— (2aq2 + sin A) pdqa 

v= 2 = 80+ cosi 50 (13.72b) 
Tr 

w = = =sin8 51 —cos@sini 5 (13.72c) 
Tr 


Instead of differentiating (u,v, w) with respect to time, we choose to use the true 
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latitude angle 6 as the time dependent variable. Let a prime symbol indicate 
a derivative with respect to 6. To differentiate the expressions in Eq. (13.72), 
only the 6@ terms must be given special consideration. Note that 

O(66) de . : 

—~— — = 66/9 = 60 13.73 

Oo dt 6 J ( ) 

Using Eq. (13.64), the partial derivative of 60 with respect to the true latitude 
is given by: 


56 = Poy (13.74) 


Taking the partial derivative of Eqs. (13.72a)-(13.72c) while making use of 
Eq. (13.74) yields the following non-dimensional rates with respect to true lati- 
tude. 

/ 


5 
u = —Syt + (p(q1 cos @ + gz sin 0) — v*) 50 








+ (3vaq, + sin 6 + vcos6) p dq1 (13.75a) 
+ (3vaq2 + cos é — vsin 6) p dq2 
v= eS OES 2v60 + (2cos6 + 3aq1) p 6q1 
2a (13.75b) 
+ (2sin@ + 3aq2) p dqa 
w’ = cos 606i + sin @ sin i6Q (13.75c) 


Note that these non-dimensional rate expressions are not necessarily simpler 
than their their dimensional counterparts. To map these rates with respect to 
true latitude into the corresponding dimensional (x, y, z) time rates, the follow- 
ing equations are used. 





&=Viu' +V,u (13.76a) 
y=Viv' +V,v (13.76b) 
eWay (13.76c) 


13.3.2. Bounded Relative Motion Constraint 


To find what conditions the orbit element differences must satisfy for the relative 
orbit to remain bounded, let us examine the orbit period of the Keplerian two- 
body problem. A bounded relative orbit is one that repeats itself after each 
chief orbit. The orbit period P is given in Eq. (8.68) as 


ae 
P=2n,|— (13.77) 
Lb 


If two satellite have different orbit periods, then they will drift apart and the 
relative orbit is considered to be unbounded. Since P only depends on the 
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semi-major axis a, two satellites will have the same orbit periods if 
da = 0 (13.78) 


is satisfied. The other five orbit element differences shown in Eq. (13.39) only 
define the relative orbit geometry, but will not cause the relative orbit to drift 
apart. Thus, while the Hill frame specialized bounded relative orbit constraint 
is Yo + 2nxp = O, the orbit element difference equivalent constraint is simply 
da = 0. However, while the Hill frame constraint is only valid assuming that 
the relative orbit size is small compared to the chief orbit radius and that the 
chief orbit is circular, the orbit element constraint is valid for any size relative 
orbit and any type of chief orbit eccentricity. 

If we do assume that the relative orbit radius is small compared to the chief 
orbit radius, then we can use the linear mapping de = [A(e,)]~1X to determine 
the general bounded relative orbit constraint for eccentric chief orbits. Using 
Eqs. (13.71a) - (13.71d), the bounded relative orbit constraint in Eq. (13.78) is 
written as 


da = 0 = 2a(2 + 3K, + 2K2)a(t) + 2Zav(1 — 2K + Ke)y(t) 


20? 2 
OP o(t) + (1 + 2K1 + Ka) G(t) (13.79) 
Vi Vi 





Note that Hill frame coordinates must satisfy this constraint at all times for the 
relative orbit to be bounded (i.e. all orbits have the same period). This general 
constraint can be further simplified by expressing it at the initial time, where to 
is defined as the time where the true anomaly f is equal to zero and the satellite 
is at the orbit periapses. Note that the orbit radius is now given by 


r(to) = rp = a(1 — e) (13.80) 


Further, the radial velocity V,. is given by 
Bins ©. 
V,(to) = r(to) = —(qi sinw — qo cosw) = 0 (13.81) 
Pp 


Thus, using Eqs. (13.67) and (13.70) we find that v = 0 and kg = 0. The 
bounded relative orbit constraint equation is now written specifically for the 
initial time as 


tee (2+34 (2 s 1)) ete (1 pn (2 = 1)) yo (13.82) 
lp Tp \Tp Vi(to) Tp \Tp 


Since Vi(to) = Tp and making use of Eq. (13.80), this constraint is further 
reduced to the simpler form 


1 
P 
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Expressing the true latitude rate 6 at perigee as 


. h VP l+e 
rp“ @d—-ee VV d—e we) 


the constraint is written in its final form as!° 


ont. Se (13.85) 
zo /A+el—ep 


Let us linearize this constraint about a small eccentricity. In this case terms 
which are linear in e are retained and higher order terms in e are dropped. 
Since we are already beginning with a linear mapping between orbit element 
difference and Cartesian Hill frame coordinates where terms of order p/r are 
dropped, this implies that e > p/r and higher order terms of e are less than or 
equal to p/r. The bounded relative motion constraint on the initial Cartesian 
coordinates is then given by 


Yo + (2+ 3e)nao = 0 (13.86) 


The find the initial Cartesian coordinates constraint for bounded relative motion 
at the chief orbit apoapses, we set r(to) = ra = a(1 + e) and follow the same 
steps. The resulting constraint for chief orbits with a general eccentricity is 


Yo ne) (13.87) 
Xo (1—e)(1+e)? 
while the constraint for chief orbits with a small eccentricity is given by 
Yo + (2 — 3e)nao = 0 (13.88) 


Note that if the chief orbit is circular and e = 0, then this constraint reduces 
to the familiar form of Yo + 2nzo = 0 found in Eq. (13.34). The more general 
bounded relative orbit constraint in Eq. (13.85) is valid for eccentric chief orbits. 
However, its form requires that to be defined to be at the orbit perigee point. 


13.4 Relative Motion State Transition Matrix 


The state transition matrix [®(t, to)] is defined in Eq. (11.195) as the sensitivity 
of the current state vector X(t) with respect to the state vector X(to) at the 
initial time. 
OX (t) 

®x(t,to)]| = | 13.89 

[Bx(tsto)) = [Sa (13.89) 
This matrix has many applications in orbital control theory and dynamical 
analysis of relative orbit motion. Let X(t) be the relative orbit position vector 
in Hill frame components of the deputy satellite relative to the chief position as 
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defined in Eq. (13.36). We are allowing here the chief orbit to be either circular 
or elliptical. However, no disturbance are considered and gravitational field 
is idealized as that of a spherical Earth. For the nonlinear dynamical system 
describing the relative motion of the satellites, the position vector at time t can 
be approximated using the state transition matrix [® x(t, to)| through 


X(t) © [®x(t, to)| X (to) (13.90) 


If the dynamical relative equations of motion were linear, then this would 
be a precise mapping between initial and current state vectors as shown in 
Eq. (11.172). 

One brute force method to generate this state transition matrix [® x(t, to)] 
would be to solve the relative equations of motion analytically for X(t) and the 
take the required partial derivatives. For a circular chief orbit, the linearized 
equations of motion have been solved using the CW equations. The result is 
shown in Eq. (13.33). For general elliptical orbits, finding the analytical solution 
of the relative equations of motion is substantially more complicated.!! 

We will pursue a simpler solution making direct use of the linear mapping 
between the Hill frame relative Cartesian position vector and the corresponding 
orbit element differences shown in Eq. (13.40). In particular, at times t and to 
we write express the relative orbit position vector as 


X(t) = [A(e(t))de(¢) (13.91) 
X (to) = [A(e(to))|oe(to) (13.92) 
Note that unless stated otherwise, all inertial orbit elements are assumed to be 


chief orbit elements. The state transition matrix of the orbit element difference 
vector de(t) is defined analogously to [®x(t, to)] as 


A(de(t)) 
@5.(t:to)| = | ——— 
[Pse(t, to)] os (13.93) 
Let the orbit element difference vector be defined using Eq. (13.41) as 
de = (da, 50, di, 5q1, 6q2, 60) (13.94) 


where 6 = w+ f is the true latitude and qi and qe are defined in Eqs. (13.42) 
and (13.43). For the Keplerian motion assumed in this section, note that all 
these orbit element difference will remain constant except for the true anomaly 
difference 60. It does evolve nonlinearly in time for general elliptical chief or- 
bits. However, for the remaining orbit element differences, the sensitivity at 
time t with respect to this state at time to will simply be 1. This will provide 
a [®5e(t,to)] matrix which has a very simple structure. If perturbations are 
included, then the computation of [®5¢(t, to)] becomes more involved. See Ref- 
erences 6 and 12 for a detailed study of including Jz perturbations and mean 
orbit elements into the state transition matrix calculations. Given the state 
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transition matrix [®5¢(t, to)], the orbit element difference vector at time t is be 
approximated as 


5e(t) © [B5e(t, to)|5e(to) (13.95) 


To compute the desired state transition matrix [® x(t, to)] in terms of [A(e)] 
and [®5e(t, to)], we substitute Eqs. (13.91) and (13.92) to find 


[A(t)|de(t) = [®x(E, to) |[A(to)]de(to) (13.96) 


Substituting Eq. (13.95) into the above equation and solving for [®x(t, to)] 
yields 


[® x(t, to)] = [A(£)][Bse(t, to)][A(to)]74 (13.97) 


The non-zero components of both [A(t)] and [A(to)] were developed earlier. 
Note that this [® x(t, to)| computation is valid for both circular and non-circular 
chief orbits. The assumption made here is that the orbit perturbations about 
the Keplerian motion are negligible. 

The only non-trivial term of the [®5¢(t,to)] matrix computation is the true 
latitude difference 


50 = bw + of (13.98) 


Since the argument of perigee difference dw will not change with time, we can 
state that 


50(t) = dw + 5f(t) (13.99) 
50(to) = dw + 6f (to) (13.100) 





and thus focus our treatment on the search of df(t) as a function of de(to). 
Kepler’s equation is given by 


M(t) = Mo+ rE ~ to) (13.101) 


For notational convenience, a subscript “0” will indicated that a state is taken 
at time to. No subscript means the state is taken at time t. Taking the first 
variation of Kepler’s equation, we are able to relate differences in mean anomaly 
at times ¢ and tp through 


56M = 6My— 3°tM — Mo) (13.102) 
a 


To express the mean anomaly differences in terms of other anomaly differences, 
we make use of the mean anomaly definition 


M=E-esinE (13.103) 
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and take its first variation to yield 


dM. aM 
M =e a 
OM Sopot ope” (13.104) 


= (1 —ecos FE)6E — sin Ede 
Using the mapping between eccentric anomaly F and true anomaly f 


f l+e E 
tan == tan — 13.1 
an 5 = an > (13.105) 





and taken its first variation, differences in F are then expressed as differences 
in f and e through 


sinf de 


1) 
Fe a ee 
2 oe 1+ecosf 7 


= 13.106 
1+ ecos f ( ) 


with n = V1 —e?. Substituting Eq. (13.106) into Eq. (13.104) and solving for 
OM using the orbit identities in Appendix E yields 


” 


oe (1+ ecos f)? 


(n°5f — sin f(2 + ecos f)de) (13.107) 


Analogously, the initial mean anomaly difference 6Mpo is expressed by taking 
advantage of the fact that only the anomalies will differ in time through 


d6Mo => Gea: (775 fo = sin fo(2 + ecos fo)de) (13.108) 


Substituting Eqs. (13.107) and (13.108) into Eq. (13.102) and solving for of 
yields? 


2 


ope Soh Mo) 6a+ (=) 5fo 
2r To 
ee Coe 
A B 


2 
+ (ss + ecos f) — sin fo(2 + ecos fo) (=) abe (13.109) 
ro 
a 
Cc 


Let us write the true anomaly differences in the following compact form 
of = Ada+ Bofo + Coe (13.110) 


In terms of the orbit elements used in Eq. (13.41), the scalar parameters are 
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defined as 

3 

ye emacs EY Fh (13.111) 
2 r? 
ean 

B= (=) (13.112) 
ro 

1 
C= —— ((sin Ogi — cos Og2)(2 + qi cos @ + go sin 6) 


mr/aqi t+ 


; (13.113) 
r 
— (sin A9q1 — cos Oog2)(2 + qi Cos 9 + G2 sin Oo) (=) ) 
0 
with the orbit radius r being defined in Eq. (13.55) and 7 = \/1—q7-— 4. 
Using the definitions of q; and gz in Eq. (13.42) and (13.43), the differences in 
eccentricity and argument of perigee as expressed as 


1 
Oe = 5 (N61 + 92592) (13.114) 
qi + 4% 
1 
bw = G+e (q1692 — 92641) (13.115) 


Substituting Eqs. (13.99), (13.100), (13.114) and (13.115) into Eq. (13.110), we 
are able to express true latitude differences at time ¢ in terms of initial orbit 
element differences through 





71 q2 
50 = Ada + Bib + | CL - = 8 5q 
: ( VE+E zz) : 
C1 


(13.116) 


q2 q1 
i GS eB as 
( VGt@ q +4 
a” 
C2 


Since all orbit element differences except for the anomalies and latitude angles 
are the same at any time, we are now able to write the orbit element difference 
state transition matrix as 


fe Oe Ole 805° 
ABOCG CG 0 
0) 00> EO Ong 

[Pseltto]=|9 9 go 1 0 0 (13.117) 
OF 003108 Oe es 
O55. Oo TOE" Oi" 


Using this matrix in Eq. (13.97), we are able to directly compute the state 
transition matrix [®x(t,to)] of the rotating Hill frame relative orbit position 
vector X at any time. The presented method could also be used to develop the 
state transition matrix using other orbit elements in an analogous manner. 
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13.5 Linearized Relative Orbit Motion 


Note that Eq. 13.59 provides us a direct linear mapping between orbit element 
differences de and the Hill frame Cartesian coordinate vector p. The only lin- 
earizing assumption that was made is that the relative orbit radius p is small 
compared to the inertial chief orbit radius r. Since this mapping must hold 
at any instance of time, however, these linearized equations also approximate 
a solution for the relative orbit motion p in terms of the true anomaly angle 
f. To map between time and the true anomaly we must solve Kepler’s equa- 
tion. However, to be able to describe the relative orbit geometry in terms of 
the Hill frame Cartesian coordinates, the solution in terms of the true anomaly 
f is preferred. The reason for this is that by sweeping f through a complete 
revolution, the (x,y,z) coordinates found through these equations will yield 
the linearized relative orbit approximation that results due to a prescribed set 
of constant orbit element differences. Note that no differential equations are 
solved here to determine the relative orbit motion, and that the dominant rela- 
tive orbit radial (x-direction), along-track (y-direction) and out-of-plane motion 
(z-direction) can be trivially extracted. 


13.5.1 General Elliptic Orbits 


However, when describing a relative orbit through orbit element differences, it 
is not convenient to describe the anomaly difference through 60 or 6f. For el- 
liptic chief orbits, the difference in true anomaly between two orbits will vary 
with throughout the orbit. To avoid this issue, the desired anomaly difference 
between two orbits is typically expressed in terms of a mean anomaly differ- 
ence 6M. This anomaly difference will remain constant, assuming unperturbed 
Keplerian motion, even if the chief orbit is elliptic. Using Eq. (13.107), differ- 
ences in true anomaly are written in terms of differences in mean anomaly and 
differences in eccentricity as 





1 7 2 “3 
éf = A ReCR DY Sy + “a (2 + ecos f)de (13.118) 
1) 
Let us define the orbit element difference vector de to consist of 
de = (a, 6M, bi, dw, de, 6Q)7 (13.119) 


Note that all these orbit element differences are constants for Keplerian two- 
body motion. Further, while using q; and q2 instead of e and w allows us to 
avoid singularity issues for near-circular orbits, for the following relative orbit 
geometry discussion such singularities do not appear. In fact, describing the 
relative orbit path using de and dw instead of dq; and dq2 yields a simpler and 
more elegant result. Using Eqs. (13.42) and (13.43), the differences in the q; 
parameters are expressed as 


dq = cos wde — esinwdw (13.120a) 
dgq2 = sinwde + ecoswdw (13.120b) 
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After substituting Eqs. (13.118) and (13.120) into the linear mapping in Eq. (13.59) 
and simplifying the result, we are able to express the relative position coordi- 
nates (a, y,z) in terms of the orbit element differences in Eq. (13.119) through 





a(f) © — 5a + GES Sip taeda hoe (13.121a) 
0 
y(f) & il + ecos f)?5M + rdw + ae +ecos f)de+rcosidQ 
(13.121b) 
z(f) & r(sin 067 — cos 6 sin idQ) (13.121c) 


Note that with this linearized mapping the difference in the argument of perigee 
dw does not appear in the 2(f) expression. Further, these equations are valid 
for both circular and elliptic chief orbits. Only the 6M and de terms contribute 
periodic terms to the radial x solution. Due to the dependence of r on the 
true anomaly f, all orbit element difference terms in the along-track y motion 
contribute both static offsets as well as periodic terms. For the out-of-plane z 
motion both the 62 and 62 terms control the out-of-plane oscillations. 

However, note that Eq. (13.121) does not explicitly contain any secular terms 
as is the case with the general solution to the CW equations in Eq. (13.33). 
For the classical two-body orbital motion, the only condition on two inertial 
orbits to have a closed relative orbit is that their orbit energies must be equal 
and thus da = 0. This constraint is valid for both circular and elliptical chief 
orbits. Also, note that this constraint is the precise requirement of the Keplerian 
motion for bounded relative orbit paths; no linearizations have been made here. 
For Keplerian two-body motion, all the orbit element differences will naturally 
remain constant except for the mean anomaly difference. If da is not zero 
between two orbits, then these orbits will drift apart due to having different orbit 
periods. In this case 6M will not remain a constant but grow larger with time. 
The linearization in Eq. (13.121) can still be used to predict the relative orbit 
motion, but only until the relative orbit radius p is no longer small compared 
to the inertial chief orbit radius r. If perturbations such as the Jz gravitational 
perturbations are included, then the appropriate orbit element differences must 
be treated as slowly time varying. Thus the potential secular drift of a relative 
orbit is hidden within the behavior of the orbit element differences themselves. 

By dividing the dimensional (x, y, z) expressions in Eq. (13.121) by the chief 
orbit radius r and making use of Eq. (13.55), we obtain the non-dimensional 
relative orbit coordinates (u, v, w). 








47 1 4 
u(f) © (1 + e008 f) pas — ED os pe (13.122a) 
u(f) = (1 + ecos et + dw + oe (2+ecos f)de+cosidQ  (13.122b) 


w(f) * sin 00% — cos 6 sin id6Q (13.122c) 
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Since (y, z) << r, the non-dimensional coordinates (v, w) are the angular deputy 
satellite relative orbit position with respect to the chief orbit radius axis. 

However, the present form of Eq. (13.122) is not convenient to determine 
the overall non-dimensional shape of the relative orbit. Reason is that there are 
several sin() and cos() functions being added here. Using the identities 


Asint+ Bcost = VV A2 + B? cos (+-tan~ (3)) 
=—VA? + B?sin (:- tan7* (4)) 


as well as standard trigonometric identities, we are able to rewrite the linearized 
non-dimensional relative orbit motion as 


0 1 26 M2 
u(f) © Os he, kaha eae ea a) 
a 7) 1) 


(13.123) 











(13.124a) 
ede e |/e?dM? 
See aig Dna Oe 
De + Dep iP + de? cos(2f — fu) 
e?\ 6M : 
u(f) & ((: + 5) ae + bu + cosist?) 
2 /[e?dM? 
pny ye de? cos(f — fu) (13.124b) 
e |e2dM? 
Saye hy cee 2 eos(2f — 
One ip + de? cos(2f — fy) 


w(f) © Vi? + sin? 1602 cos (8 — Ow) (13.124c) 


with the phase angles f,, f, and 6, being defined as 








M 
fu = tan? (=) (13.125) 
fy = tan (25) = fur . (13.125b) 
5s 
Oy = tan" (3) (13.125c) 


At these phase angles, the trigonometric terms will reach either their minimum 
or maximum value. Note that 180 degrees can be added or subtracted from 
these angles to yield the second extrema point of the trigonometric functions. 
To further reduce the expression in Eq. (13.124), let us introduce the small 


states 6, and 6,,): 
25M2 
by = 4] —— + be? (13.126) 
V9 


Ow = V 012 + sin? id? (13.126b) 
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Using these 6, and 6,, definitions as well as Eq. (13.125b), the linearized relative 
orbit motion is described through 


u(f) © ~5a - a + “3 (cos(f — fu)t+ 5 00s(2f _ fu)) (13.127a) 
o(f) = ((: + 5) ou + bu + cosiat) 
; q : (13.127b) 
ie (2 sin(f — fu) + 5 sin(2f - fu)) 
w(f) © dw cos (8 — Oy) (13.127c) 


Note that the cos(2/) and sin(2/) terms are multiplied by the eccentricity e. 
Only if the chief orbit is very eccentric will these terms have a significant con- 
tribution to the overall relative orbit dimension. For the more typical case of 
having a chief orbit with a small eccentricity e, these terms only provide small 
perturbations to the dominant sin(f) and cos(f) terms. Using Eq. (13.127), it 
is trivial to determine the maximum radial, along-track and out-of-plane dimen- 
sion of a relative orbit provided that the relative orbit geometry is prescribed 
through the set of orbit element differences {da, de, 61, dQ, dw, dM}. Note that 
this linearized relative orbit motion is valid for both circular and elliptic chief 
reference orbits. The only linearizing assumption made so far is that the rel- 
ative orbit radius is small compared to the planet centric inertial orbit radius. 
However, note that we are only estimating the non-dimensional relative orbit 
shape. To obtain the true radial, along-track and out-of-plane motions, we need 
to multiply (u,v,w) by the chief orbit radius r. Since r is time dependent 
for an elliptic chief orbit, the points of maximum angular separation between 
deputy and chief satellites may not correspond to the point of maximum phys- 
ical distance. To plot the dimensional linearized relative orbit motion, we use 
Eq. (13.121) instead. However, due to the ratio’s of sin() and cos() terms, it is 
not trivial to obtain the maximum physical dimensions of the relative orbit. 

Let us take a closer look at the out-of-plane motion. The true latitude angle 
Ow, at which the maximum angular out-of-plane motion will occur, is given by 
Eq. (13.125c). As expected, if only a 6Q is prescribed, then the maximum w 
motion occurs during the equator crossing at 6 = 0 or 180 degrees. If only a 67 
is prescribed, then the maximum w motion occurs at 6 = +90 degrees. 

The maximum angular out-of-plane motion is given by the angle 6,, as shown 
in Figure 13.5. This angle 6, is the tilt angle of the deputy orbit plane relative 
to the chief orbit plane. As such, it is the angle between the angular momentum 
vector of the chief orbit and the angular momentum vector of the deputy orbit. 
To prove that 6, is indeed this angle, let us make use of the spherical law of 
cosines for angles. Using the spherical trigonometric law of cosines, we are able 
to relate the angles 6Q, i, di and 6, through:!® 





cos Oy = cosicos(t+6i) + sini sin(¢+42) cos 6Q (13.128) 


Assuming that 60, 67 and 6, are small angles, we approximate sina + x and 
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deputy orbit 





Figure 13.5: Illustration of Orbit Plane Orientation Difference between 
Chief and Deputy Satellites 


cosx © 1 — x?/2 to solve for by. 


Ow = V 0i2 + sin? i602 (13.129) 


Using the angle 6,,, the out-of-plane motion wu in Eq. (13.127c) is written in the 
compact form shown.!*+ ! 


13.5.2 Chief Orbits with Small Eccentricity 


In this section we assume that the chief orbit eccentricity e is a small quantity. 
In particular, we assume that e is small but greater than p/r, while powers of 
e are smaller than p/r. In this case we only retain terms which are linear in e 
and drop higher order terms of e. The orbit radius r is now approximated as 


an? 


= ——_val(l- ; 13.130 
r (eos a(1 — ecos f) ( ) 


while 7? ~ 1. The linearized dimensional relative orbit motion in Eq. (13.121) 
is written for the small eccentricity case as: 


x(f) = (1 — ecos f)da + GES Far —acos foe (13.131a) 
1) 


y(f) » —(1 + ecos f)dM + a(1 — ecos f)dw 


a 
n (13.131b) 
+ asin f(2 — ecos f)de + a(1 — ecos f) cos idQ 


z(f) © a(1 — ecos f)(sin 062 — cos @ sin 16Q) (13.131c) 
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Making use of the trigonometric identity in Eq. (13.123), the (a, y, z) motion is 
written as 


x(f) + da+ ad, cos(f — fr) (13.132a) 
y(f) xa (~ + dw + cos isn) — adysin(f — fy) — > sin(2f)de (13.132b) 
2(f) © ad, cos(@ — 0,) — ag cos(2f — fz) 

a 2 (13.132c) 
og. (sin wdt — cosw sin idQ) 


with the small states 6, d, and 6, defined as 


2 2 2 
i, =4/- x 4 (se ~) (13.133a) 
1) a 


2 
dy = \/40e? 4+ e? (= — dw — cos isn) (13.133b) 
1) 


6, = V6i2 + sin? i602 (13.133c) 


and the phase angles f,, fy, 0, and f, defined as 





6M 
fi, >tan-* [ae (13.134a) 
e€ (a4 — dw — cos is) 
f, Stan = = (13.134b) 
6, =tan* (tog) (13.134c) 
_, [ cosw0di + sinw sin 160. 
= ——— 13.134d 
Je = tan (= wdi — cosw sin 162 nee) 


Note that the orbital radial motion x(f) for the small eccentricity case is iden- 
tical to the general orbit radial coordinate in Eq. (13.121la) if da is zero. The 
semi-major axis different must be zero for bounded relative motion if no pertur- 
bations are present. With perturbations present, da may be non-zero and the 
orbit radial coordinate will then be different between the linearizing approxi- 
mations. The estimated along-track motion y(f) and out-of-plane motion z(f) 
will always be numerically different between the generally elliptic case and the 
small eccentricity case. 

The dimensional form of the relative orbit motion in Eq. (13.131) is conve- 
nient to determine the amplitudes of the sinusoidal motion in either the along- 
track, orbit radial or out-of-plane motion. Note that since e is considered small, 
the double-orbit frequency terms sin(2f) are only a minor perturbation to the 
dominant orbit frequency sinusoidal terms. 
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13.5.3. Near-Circular Chief Orbit 


If the chief orbit is circular or near-circular, then the linearized relative equations 
of motion are given through the famous Clohessy-Wiltshire or CW equations.* 
Assuming the bounded relative motion constraint Yo + 2nxz9 = 0 is satisfied, 
then the differential CW equations can now be solved for the analytical solution 
of the relative orbit motion shown in Eq. (13.33). 


x(t) = Ap cos(nt + a) (13.135a) 
y(t) = —2Apsin(nt + a) + Yor f (13.135b) 
z(t) = Bo cos(nt + (3) (13.135c) 





The integration constants Ao, Bo, a, 3 and yor are determined through the 
relative orbit initial conditions. These equations have been extensively used 
to generate relative orbits if the chief orbit is circular. Let us now compare 
the predicted (x,y, z) motion in terms of the true anomaly in Eq. (13.132) to 
the CW solution in Eq. (13.33) if the chief orbit is assumed to be near-circular 
(i.e. e < p/r). In this case terms containing the eccentricity e are dropped, 
as compared to the small eccentricity case studied earlier where only higher 
order terms of e were dropped. Assuming that all de components are small 
(i.e. the relative orbit radius is assumed to be small compared to the inertial 
orbit radius), and letting e — 0, we find that r > a and 7 — 1. Further, 
note that f, and fy, approach 0. Using Eq. (13.132) the relative orbit motion 
(x(f), yf), z(f)) is expressed for the near-circular chief orbit special case as 


x(f) ¥ da — acos fde (13.136a) 
y(f) © a(dw + 6M + cosidQ) + 2asin fde (13.136b) 


2(f) & av 6i? + sin? i5Q? cos (0 — 0.) (13.136c) 


Note that the maximum width of the oscillatory along-track motion y is given 
by 2ade. This result has been previously presented in References 15 and 16. 
Comparing Eqs. (13.33) and (13.136) and noting that nt = f for this case, we 
are able to establish a direct relationship between the CW constants and the 
orbit element differences. 


Ag = —ade (13.137a) 
Bo = aV/5i2 + sin? 1692 (13.137b) 
a=0 (13.137c) 
B=w-6, (13.137d) 
Yor f = a(dw + 6M +4 cosidQ) (13.137e) 


Recall that Eqs. (13.33) require that the bounded relative motion constraint is 
satisfied. Thus the 6a term is set to zero when comparing the two forms of the 
relation orbit motion expression. 


SECTION 13.5 LINEARIZED RELATIVE ORBIT MOTION 509 


Example 13.2: The following numerical simulations verify that the relative 
motion approximation in Eqs. (13.121), (13.132) and (13.136) do indeed 
predict the spacecraft formation geometry. These simulations also illustrate 
the accuracy at which these simplified linearized solutions are valid. Let the 
chief orbit be given by the orbit elements shown in Table 13.1. 


Table 13.1: Chief Orbit Elements 


Orbit Elements Units 
a 7555 km 
e 0.03 or 0.13 
t 48.0 deg 
Q 20.0 deg 
Ww 10.0 deg 
Mo 0.0 deg 





The relative orbits are studied for two different chief eccentricities. For the 
relative orbits studied, the ratio p/r is about 0.003. The smaller of the two 
eccentricities considered is already an order of magnitude larger than this, 
while the second eccentricities is even larger again. The numerical simulations 
show that the small eccentricity assumption (i.e. retaining terms in e but 
dropping higher order terms in e) will still yield a reasonable relative orbit 
prediction for e = 0.03, even though it is larger than the small term p/r. The 
orbit element differences which define the relative orbit are given in Table 13.2. 
Since these simulations assume a two-body Keplerian motion of the satellites, 
the semi-major axis difference da must be zero to achieve a bounded relative 
motion. 


Table 13.2: Orbit Element Differences Defining the Spacecraft Forma- 
tion Geometry 


Orbit Elements Units 
da km 
de 0.00095316 
ot 0.0060 deg 
dQ 0.100 deg 
bw 0.100 deg 
d0Mo -0.100 deg 





The following figures compare the relative orbit motion for four different 
cases. Case 1 is the relative motion that will result using the true nonlinear 
equations of motion. Case 2 uses the dimensional linearized analytical relative 
orbit solution in Eq. (13.121). The only assumption that has been made here 
is that ratio between the relative orbit radius p and the inertial chief orbit 
radius r is small and terms involving p/r have been dropped. Case 3 assumes 
that the chief orbit eccentricity is small, but not near zero. As such, higher 
order terms in e are dropped, while terms which depend linearly on e are 
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Figure 13.6: Comparison of the Linearized Relative Orbit Solutions for 
Cases 1-4 with e = 0.03 and e = 0.13. 
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kept. The relative orbit motion is described through Eq. (13.132). Case 4 
assumes that the chief orbit is near-circular and that e is very close to zero. 
Any terms involving the eccentricity e are dropped here to yield the classical 
CW equations in Eq. (13.136). Case 4 is not included here to suggest that 
a circular orbit assumption should be made when the chief orbit is clearly 
eccentric. The circular chief orbit assumption case is included to provide a 
relative comparison illustrating the extent of the eccentricity effect. 

The resulting relative orbit motion is illustrated in Figure 13.6. Figures 13.6(i) 
and 13.6(ii) show the three-dimensional relative orbits for cases 1 through 4 
as seen by the rotating Hill reference frame. The relative orbit radii vary be- 
tween 10 and 20 kilometers. When e = 0.03, note that the relative orbits for 
cases 1-3 are virtually indistinguishable. Only the relative orbit prediction as- 
suming a circular orbit (case 4) has a clearly visible distinct motion. Studying 
Figure 13.6(ii) with e = 0.13, the case 2 relative orbit is still indistinguish- 
able on this scale from the true relative motion in case 1. With this larger 
eccentricity the relative motion predicted in case 3 (dropping higher order 
terms in e) does show some visible departure from the true relative motion. 
As expected, the circular chief orbit assumption (case 4) yields a very poor 
prediction of the relative orbit motion. 

In Figures 13.6(iii) and 13.6(iv) the RMS relative orbit errors are shown in 
polar plots versus the chief orbit true anomaly. For the e = 0.03 simulations, 
the relative orbit errors for case 2 lie between 20 and 40 meters. Since the 
relative orbit radius is roughly 10 kilometers, this corresponds to a 0.2-0.4 
percent relative motion error. The RMS relative motion error for case three is 
only marginally worse. As was discussed earlier, dropping the higher order e 
terms should begin to have a noticeably affect on the relative motion errors. 
For the e = 0.13 simulations, the relative motion errors for case 2 lie between 
50 and 100 meters (roughly 0.5-1.0 percent errors). However, dropping the 
higher order e terms in case 3 has a very noticeable effect with the relative 
motion errors growing as large as 500 meters (about 5.0 percent error). 


13.6 J>-Invariant Relative Orbits 


To motivate the discussion in this chapter, let us revisit one particular class of 
spacecraft formations where the satellite constellation is composed to form a 
rotating sparse aperture. These types of formations are typically considered in 
remote sensing missions where each satellite is an individual element of a large, 
virtual antenna formed by the formation. By sharing the individual measure- 
ments, the resolution of the spacecraft cluster is potentially much higher then 
the resolution of any individual craft. To minimize secular relative drift among 
the spacecraft, these missions typically are comprised of identical spacecraft to 
reduce the differential atmospheric drag. The spacecraft formation orbit will 
decay due atmospheric drag. However, all satellites orbits will decay are nomi- 
nally the same rate. Thus, the atmospheric drag has only a secondary effect on 
the relative orbit geometry. The gravitational perturbations are typically the 
dominant factor producing the secular drift in this case. Ignoring these pertur- 
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bations leads to relative orbit designs which require more frequent corrections, 
and thus use more fuel. 

Adding the Jz perturbation to the classical Keplerian orbit motion causes 
three types of changes in the osculating orbit elements, short period and long 
period oscillations, and secular growth. The long period term is the period of 
the apsidal rotation. Over a short time this looks like a secular growth of O(J2). 
The short period growth manifests itself as oscillations of the orbit elements, but 
doesn’t cause the orbits to drift apart. The relative secular growth is the motion 
that needs to be avoided for relative orbits to be Jz invariant. This growth is 
best described through mean orbit elements rather than the osculating elements. 
These orbit elements have the short and long period oscillations removed. A 
direct mapping between the osculating (instantaneous) orbit element and the 
mean (orbit averaged) orbit elements is provided by Brouwer in Reference 17. 
A popular modification to make this algorithm more robust near zero eccen- 
tricities and orbit inclinations was introduced by Lyddane in Reference 18. A 
numerical algorithm providing a first order approximation to this osculating to 
mean element mapping is provided in Appendix G. By studying the relative 
motion through the use of mean orbit elements,!® 7! we are able to ignore the 
orbit period specific oscillations and address the secular drift directly. It is not 
possible to set all of the individual orbit drifts equal to zero. However, instead 
we choose to set the relative mean orbit element drifts to zero to avoid relative 
secular growth. 

The Jz perturbations cause secular drift in the mean longitude of the as- 
cending node 9, the mean argument of perigee @ and the mean anomaly M. 
As shown in Eq. (11.87), the non-zero mean orbit element rates due to the J2 
gravitational perturbation are given by: 


dQ 3 EEN cd 

poe) Seas oe ; 13.1 

a = Jan ( . ) cos i (13.138a) 
dz 3 ree es 

ee ae 4 13.1 

a “Jan ( ; ) (5 cos* i — 1) (13.138b) 


dM 3 Teq \? 
a qian (“) V1 —e2(3cos”i — 1) (13.138c) 
P 


The magnitude of the secular drifts are determined by the semi-major axis a, 
eccentricity e and the inclination angle i.?? If these quantities aren’t carefully 
selected, then the relative drift rates will cause secular drift among the various 
spacecraft in the formation.!9 


13.6.1 Ideal Constraints 


For Keplerian motion (i.e. no gravitational perturbations present), only the 
mean anomaly M is a time dependent orbit element. The rate at which M 
grows is given by the mean orbit rate n. For the relative motion between to 
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satellites to be bounded, the mean anomaly rates must be equal. 


BSN ig cacy a ES as, 13.139 
3 3 
ag ae 


Since the mean anomaly rate only depends on a, the difference in mean anomaly 
rates 6M can also be approximated to first order as 


. aM. ~ 8 A 


This leads to the same result as is shown in Eq. (13.78) which states that da = 0 
must be true for the relative orbit to be bounded in a Keplerian system. Note 
that here 6a is defined as 





0a = Ag — Ae (13.141) 


We would like to expand this method of finding bounded relative orbit con- 
straints to orbit which include the J2 gravitational perturbation effect. We 
attack this problem by working in the mean element space such that the mean 
orbit element drift rates shown in Eq. (13.138) are valid. For notational conve- 
nience the overbar notation to denote a parameter as being a mean element is 
dropped here. Unless stated otherwise, all shown orbit parameters are assumed 
to be mean elements with the short and long period motion removed. The 
following algebra is greatly simplified if we work with dimensionless variables. 
Therefore distances will be measured in Earth radii reg and time is normal- 


ized by the mean motion Neg = 1/1/72, of a satellite at one Earth radius. Let 
T =tNeq be the new time, then mean ascending node rate is written as 

dQ = dQ dr 

= = i) 13.142 

dt dr dt oo ae 
where the notation ()’ = d()/dr is introduced. Using 7 = V1 -—e?, the non- 
dimensional ascending node rate can then be expressed as 


3 rz cosi 
Qi =-= Vie 13.14 
52 aC sa (13.143) 


Let us define the non-dimensional semi-major axis measure D as 





p=— (13.144) 


Teq 


This allows us to write the there non-dimensional mean orbit element rates as 


3. Cosi 
3. (5cos?i — 1) 
i= <> Tae (13.145b) 
a= 1 3, (3cos?i-1) aade 
= Te + 1 hae ( , c) 
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Since the mean angle quantities M, w and Q do not directly contribute to 
the secular growth caused by Jz, their values can be chosen at will. However, 
the values of L, 7 and 7 (and therefore implicitly a, e and 7) must be carefully 
chosen to match the secular drift rates shown in Eq. (13.145). To keep the 
satellites from drifting apart over time, it would be desirable to match all three 
rates (Q’,w’, M’) between the various satellites in a given formation. However, 
this can only be achieved by having the L, 7 and 7 being equal, which in return 
severely restricts the possible relative orbits. Therefore we chose the bounded 
relative orbit condition to define the relative average drift rate of the angle 
between the satellite position vectors be zero. This results in 


=, (13.146) 
Mt, = Mh + = Oy, (13.147) 


where 0x is the mean argument of latitude. Thus, the arguments of perigee and 
the mean anomalies are allowed to drift apart. In fact, they end up drifting apart 
at equal and opposite rates.!9 Imposing equal latitude rates instead of forcing 
equal argument of perigee and mean anomaly drift has little consequence on 
the general spacecraft formation geometry if the eccentricity is small. For the 
case of having a circular orbit (i.e. e = 0), then having the relative w and M 
drift apart has no consequence at all. However, for relative orbits with a larger 
eccentricity, having the w and M drift apart at equal and opposite rates causes 
the relative orbit to “balloon” out and in again as the argument of perigees drift 
apart from their nominal values. Combining Eqs. (13.145b) and (13.145c), the 
mean latitude rate 04, is expressed as 


1 3 


Oy Gat ge [n (3cos? i — 1) + (5cos? i — 1)] (13.148) 


1 
Lin 
The drift rate Outs of a neighboring orbit can be written as a series expansion 
about the chief orbit element as 


a6, 
£60 
Be On 


Oo 06", 
Me g_) 4. ~~ Me 


Oi 











Ou, = OM, + i+ HOLT. (13.149) 


where we make use of the fact that 64, = 04,(L,7,1) only. Let the difference 

in latitude rates be 664,, then a first order approximation of Eq. (13.149) is 

written as 

On, 
Oi 





a6 a6 
504, = Oy, — Oy, = ML + Min + 


aE = bi (13.150) 


Similarly, the difference in nodal rate 9’ is expressed as 


/ / / 
= Se eae oi (13.151) 
4 


Q' = 
OL On 











For notational convenience, the sub-script “c” is dropped from here on. Unless 
noted otherwise, all orbit parameters are assumed to be chief orbit parameters. 
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To enforce equal drift rates 04, and 2’ between neighboring orbits, we must set 
664, and 69’ equal to zero in Eqs. (13.150) and (13.151). Taking the appropriate 
partial derivatives of Eq. (13.61) and substituting them into Eq. (13.150), the 
condition that enforces equal latitude rates is rewritten as: 


SOL + eg — 3cos* i) + (1 — 5 cos” i)] 5L 


21 
aaa int 
3 
+ Joa—= ALT; [3n(1 — 3 cos z) + 4(1 — 5 cos? é)] 67 


— Jo——(3n + 5) cosisinidi =0 (13.152) 


3 
QL! 
Note that only the term dL appears without being multiplied by the small 
parameter Jz. Thus dL must be itself of O(J2) and the term involving J26L 
is dropped as a higher order term. The first orbit element constraint is then 
simplified to 


— 6L + Jz— > [3n(1 — 3 cos” i) + 4(1 — 5 cos” t)] 6n 


1 
4L37> 


— Joa — (3n + 5) cosisinidt =0 (13.153) 


1 
21374 
Taking the partial derivatives of Eq. (13.145a), the second condition for Jo 
invariant orbits is written as 


3 7 

aor 7 COsidL + 4cosidn + 1 sin 5 =0 (13.154) 
Since 6L = O(c) the 6L term is dropped. Thus, the condition that results in 
equal nodal precession rates for two neighboring orbits is: 


én = —F tan di (13.155) 


Observe that as the chief satellite approaches a polar orbit (i.e. =90 degrees), 
the necessary change in eccentricity results in an eccentricity greater than unity 
(hyperbolic orbit) or less than zero. This issue will be discussed in more detail 
later on. Using the 67 defined in Eq. (13.155), we are able to simplify the equal 
relative latitude rate condition in Eq. (13.153) to 


Jp 
6L = Te (4+ 30) (1 + 5 cos? i) Lon (13.156) 
so 
D 


Combined, Eqs. (13.155) and (13.156) provide the two necessary conditions 
on the mean element differences between two neighboring orbits to yield a J2 


invariant relative orbit. When designing a relative orbit using the mean orbit 
element differences, either di, de or da is chosen, and the other two element 
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differences are then prescribed through the two constraints. The remaining 
mean orbit element differences 60, dw and 6M can be chosen at will without 
affecting the Jz invariant conditions. Further, note that these two conditions 
are not precise answers to the nonlinear problem, but are only valid up to a first 


order approximation. Thus, relative orbits designed with these two conditions 
will still exhibit some small relative drift. 


Example 13.3: Let us investigate the effect of dropping the terms con- 
taining J2dL when developing the two orbit element constraint equations 
in Eq. (13.155) and (13.156). The reason for this simplification is that in 
Eq. (13.152) 6L is the only term appearing without being multiplied by J2, 
and thus must itself be of order Jz. However, as the inclination angle ap- 
proaches either 0 or 90 degrees, then the term in Eq. (13.152) which contains 
dt would also become very small. Thus, ignoring the J2dL terms in these 

cases could potentially contribute lead to significant numerical errors. 

The following development will show that the error introduced by neglecting 

the J2dL terms in minimal. If the J2dL terms are retained, then the two Jo 

invariant relative orbit conditions take on a more complicated form: 


ina ut (7J2(n — 2)(5 + 37) cosisiné + n(4L4n* — 7J2(1 + 7)) tani) 
1 ~T6LAn® — TJa(4n? + — 4) + TJa(n(ll + 12) — 20) cos? i 
2. 
sL= J2(4 + 37)(1 + 5 cos* 4) Diy 
n(4L4n* — 7J2(1 + 7)) + 14J2(n — 2)(5 + 3n) cos? i 


Note that these orbit element constraints perfectly satisfy the first order con- 
ditions in Eqs. (13.152) and (13.154). If the higher order terms are dropped, 
then the previously presented Jz invariant orbit constraints are retrieved. 
However, these more precise conditions on the mean orbit element are also 
more complex and analytically less trackable than their simplified cousins. 
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Figure 13.7: Percent Error in Computing 6L by dropping the «dL Terms 


Figure 13.7 illustrates the percent error in computing the dL correction for a 
range of eccentricities and inclination angles. Here L is set to be 1.054. As 
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the figure shows, the numerical errors involved in using the simplified orbit 
constraint conditions are typically less than or equal to 1.5 percent. Only as 
the eccentricities grow larger do the numerical errors start to grow larger. It is 
interesting to note that dropping the J2dL term causes the largest numerical 
errors for near-zero inclination angles, while near-polar orbits show the least 
numerical errors. The numerical errors in computing 67) and 61 are essentially 
equivalent. Thus, using the simplified Jz orbit element constraints results in 
minimal numerical errors. For cases where the numerical errors are too large, 
the more precise expressions can be used. 


For more physical insight into the Jz invariant relative orbit constraints, it 
is convenient to map the differences in L into differences in the semi-major axis 
a. Recalling that L = \/a/req (L is a non-dimensional variable), the variations 
in Z and a are related through 


Apes 1 da 


Sse 13.157 
2L req ( ) 


Substituting Eqs. (13.157) into Eq. (13.156), the constraint enforcing equal lat- 
itude rates between two orbits is rewritten as 
a2 
da = 2D—dn (13.158) 
Tea 
Combined, Eqs. (13.155) and (13.158) form the two necessary mean orbit ele- 
ment constraints expressed in terms of a difference in semi-major axis, eccen- 
tricity and inclination angle. 
Note that it is numerically preferable to express the differences in eccentricity 
in terms of 67, and not in terms of the eccentricity de itself. The reason for this 
is clear when we observe the variation of 7 = V1 — e?. 


de= — ton (13.159) 


Using Eq. (13.159) clearly poses numerical difficulties whenever the orbits be- 
come circular. A finite change in 7 would erroneously appear as an infinite 
change in e. Thus, it is preferable to deal with 67 quantities and then use the 
precise mapping 7) = af —e?) to map these differences into corresponding de 
quantities. 

If Jo is set to zero (i.e. pure Keplerian motion), then we are only left with 
the constraint that 6a = 0. This makes sense intuitively, since the semi-major 
axis a determines the orbit period. For Keplerian motion, if the orbit periods 
are not equal, then the two spacecraft will drift apart. Thus, for Keplerian 
motion the initial conditions that result in relative motion orbits that do not 
drift apart are constrained to a five dimensional manifold , or in the (a, e, 7?) 
space to a two dimensional manifold, the surface of the sphere as illustrated in 
Figure 13.8. For a particular chief orbit with a, e and 7, the neighboring orbit 
momenta elements must lie on this surface. However, once the Jz perturbation 
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J,# 0 constraint line 
J,= 0 constraint surface 





Figure 13.8: Drift Free Constraint Illustration In Momenta Space 


is included, the geometric constraint on the momenta elements to achieve drift 
free relative motion is a straight line which is not tangent to the sphere surface. 
Thus, the presence of gravitational perturbations changes the dimension of the 
constraint manifold from two to one. 


Example 13.4: Let us illustrate the relative orbit drifts that may be intro- 
duced if the relative orbit is not setup correctly. The chief orbit elements 
using in this numerical simulation are shown in Table 13.3. The dynami- 
cal orbit model used in the numerical simulation includes the Jz through Js 
gravitational perturbations. The relative orbit is described by choosing the 


Table 13.3: Mean Chief Satellite Orbit Elements. 


Orbit Elements Value Units 


a 7153) km 

e€ 0.05 

a 48 deg 

Q 0.0 deg 

Ww 30.0 deg 
Mo 0.0 deg 


following mean orbit element differences. To achieve some out-of-plane mo- 
tion, an ascending node difference of 6Q = 0.005 degrees is prescribed. The 
line of perigee and initial mean anomaly differences are set equal and opposite 
in sign as dw = 0.01 degrees and 6Mp = -0.01 degrees. Further, we chose 
to prescribe a change in eccentricity de = 0.0001 to exaggerate the in-plane 
relative orbit. Using Eqs. (13.155) and (13.158), the corresponding changes 
in a and 7 must be da = -0.351765 meters and 62 = 0.001035 degrees. Note 
that both the required da and 57 to compensate for this de are rather small. 
The relative orbits of two different simulation runs are shown in Figure 13.9 
as seen in the rotating Hill frame. The plots show the data of 45 orbits, which 
correspond to roughly 3 days of simulation time. The initial relative orbit is 
shown as a solid black line, while the path of the remaining 45 orbits is shown 
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Figure 13.9: Relative Orbit Drift for a Non-Polar Master Orbit 


as a red line. Both simulations use the same initial orbit element differences. 
However, in Figure 13.9(i) the initial orbit element differences, which deter- 
mine the initial shape of the relative orbit, are chosen in osculating element 
space. Substantial relative orbit drift is apparent due to the perturbative in- 
fluence of Jz. Figure 13.9(ii) illustrates the drastic improvements that may 
occur if the initial orbit geometry is setup in mean element space. Since the 
matching conditions in Eq. (13.158) and (13.155) are only up to first order, 
the relative orbit will not necessarily be perfectly Jz invariant. While some 


periodic thrusting is still necessary, the frequency of these orbit corrections 
can be greatly reduced. 


13.6.2 Energy Levels between J2-Invariant Relative Orbits 


It is interesting to study the energy levels of two neighboring orbits that are J2 
invariant using the necessary first order conditions established in Eqs. (13.155) 
and (13.158). For the system studied, the Hamiltonian H is the total energy. 


Including the Jz term, the averaged energy in terms of normalized orbit elements 
is given by 


1 1 2. 
Pe a i—1) (13.160) 
Where for Keplerian motion the energy level of an orbit only depends on the 
semi-major axis measure L, including the J2 effect makes the energy expression 
depend on all three elements L, 7 and i. The difference in energy 6H of a 
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neighboring orbit and a reference orbit is approximated as 


OH OH Of .. 


Computing the partial derivatives in Eq. (13.160) while keeping in mind that 
OL is of order O(J2), we find that 


1 
oH = zai + Jo [(3 cos? i — 1)6n + 2n sini cos tdi] (13.162) 


3 
AL S74 
For two neighboring orbits to be Jz invariant, the differences in L, 7 and 7 must 
satisfy the two conditions in Eqs. (13.156) and (13.155). Substituting these 
variational constraints, the energy difference between two J2 invariant orbits is 
given by 


tani 


qa + 5 cos? i)di (13.163) 
” 


OH = —Jp 


Eq. (13.163) states that if the two orbits have a non-zero difference in inclination 
angle 6i (or implicitly a difference in 7 or L), then the two orbits must have 
different energies. Only if all three elements L, 7 and 7 between two orbits are 
equal will the orbit energies themselves be equal. Note that this condition still 
allows the two orbits to have different mean M, 2 and w between the orbits. 
Thus is it possible to have J2 invariant relative orbits with zero energy difference 
between deputy and chief satellites. This energy difference must be non-zero 
however if the relative orbit is to have out-of-plane relative motion due to having 
a difference in inclination angles. 

From this energy study an interesting conclusion can be made on the out- 
of-plane stability of the CW equations in Eq. (13.19c). The linearized relative 
equations of motion clearly indicate that the out-of-plane motion will take on 
a stable sinusoidal form. The bounded relative orbit constraint yo + 2nxzo = 0 
does not even involve the out-of-plane coordinate z. This constraint was shown 
to be equivalent to saying that da = or that the orbit energies must be equal. 
Thus, solely considering the CW equations, it appears that the relative orbit 
motion is bounded for any out-of-plane motion. However, if any of this out- 
of-plane motion is due to a difference in inclination angles, then Eq. (13.163) 
clearly shows the relative energy difference can not be zero if the relative orbit 
is to be bounded. This illustrates that the CW equations are not well suited for 
performing any long-term stability study of the relative orbit. 


13.6.3. Constraint Relaxation Near Polar Orbits 


For near-polar orbits, where the inclination 7 approaches 90 degrees, the equal 
relative nodal rate condition in Eq. (13.155), given by 


én = — 4 tani ot 
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may pose some practical problems in designing J2 invariant relative orbits. The 
issue here is that as i approaches 90 degrees, and the relative orbit design 
commands out-of-plane motion at the maximum latitude (i.e. 6% is non-zero), 
then the corresponding change in eccentricity becomes unpractically large. The 
result is that the relative orbit becomes excessively large. Note that this near- 
polar issue only arises if a specific mean inclination angle difference is prescribed 
and the two Jz constraints are then used to compute the necessary mean da and 
oi. If a change in mean semi-major axis or eccentricity were required for a near- 
polar orbit, then the equal nodal rate condition in Eq. (13.155) would require a 
very small corresponding mean inclination angle difference. Thus, achieving out- 
of-plane motion the maximum latitude poses the greatest challenge in designing 
Jz invariant relative orbits. If the out-of-plane motion should occur during 
the equator crossing, then this can be achieved by describing a difference in 
ascending nodes 62. Since the three angular quantities dQ, dw and 6M can be 
chosen at will, no practical issues would arise here. 

That the relative orbits become excessively large for near-polar orbits if 
a 0% is prescribed was also shown in the previous relative energy discussion. 
Studying Eq. (13.163) is it clear that if the chief orbit is a polar orbit, a finite 
6i requires an infinite difference in orbit energy, an unrealistic condition. Thus, 
as the inclination approaches 90 degrees the size of the relative motion orbits 
increases. 

The problem posed by attempting to design a J invariant relative orbit for 
a near-polar chief orbit is illustrated in the following numerical simulation. The 
chief mean orbit elements used are shown in Figure 13.4. 


Table 13.4: Mean Chief Satellite Orbit Elements for Near-Polar Case 


Study. 
Mean 
Orbit Elements Value Units 
a 7153) km 
€ 0.05 
a 88 deg 
h 0.0 deg 
g 30.0 deg 
l 0.0 deg 


The numerical simulations are performed by integrating the nonlinear orbit 
equation 


dos tf 

where the perturbative acceleration f(r) includes the zonal Jz through Js ef- 
fects. The relative orbit is described by choosing the mean orbit element dif- 
ferences 6Q = 0.0 degrees (all out-of-plane motion produced through 61), dw = 
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Figure 13.10: Relative Orbit Drift for a Near-Polar Chief Orbit 
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Figure 13.11: Mean and Osculating Orbit Element Differences for Case 
2 


0.1 degrees and 6M = -0.1 degrees. Case 1 assumes the relative orbit geometry 
requires a 67 of 0.01 degrees to achieve roughly 1 km of out-of-plane motion at 
maximum latitude. To achieve a desired 6% of 0.01 degrees without inducing 
relative drift in the other orbit elements, the remaining two momenta elements 
differences must be de = 0.020648 degrees and da = -27.2122 meters. The result- 
ing relative orbit is shown in Figure 13.10(i). Note that the necessary difference 
in eccentricity is very large, causing the relative orbit to become very large in 
the along track and radial direction. However, no apparent drift is visible for 
the 45 orbits plotted on the scale shown. 

One method suggested in Reference 19 is to drop the equal relative nodal 
rate condition in Eq. (13.155) when a di is prescribed for a near-polar chief 
orbit. The 67 of 0.01 degrees is retained in case 2 shown in Figure 13.10(ii), but 
it is not used to prescribe a corresponding difference in eccentricity. Instead, a 
de of 0.0001 is chosen and the corresponding da of -0.24157 meters is computed 
through the equal relative latitude rate condition in Eq. (13.158). The resulting 
relative orbit does exhibit some drift since the ascending nodes are drifting apart. 
Over a year, the Av required to compensate for this drift is roughly 56.8 m/s. 
However, for case 3 the equal latitude rate condition is also dropped (i.e. da = 
0 meters for the same de), then the resulting orbit shown in Figure 13.10(iii) 
has some clear along-track drift. Case 4 has the same initial orbit element 
differences as the ones used in case e, but here the orbits were established using 
osculating orbit elements instead of mean orbit elements. The resulting relative 
orbit is shown in Figure 13.10(iv). This would be analogous to setting up the 
relative orbit initial conditions using the CW or Hills equations. Over the 45 
orbits shown, clearly substantial drift would result. This emphasized the point 
that one should be working with mean orbit elements when design the relative 
orbits. 

Figure 13.11 illustrates the relative nodal and latitude rate drifts for case 2. 
By dropping the equal nodal rate condition, the nodes clearly drift apart over 
time. The corresponding osculating relative ascending node variations are not 
visible due to the large drift. While the relative latitude drift is not perfectly 
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zero, it is kept very small. The fuel estimate to compensate for the 60,¢ drift 
over one year is only 1.45 m/s, while it would be about 14.1 m/s if the equal 
latitude rate condition is dropped. However, as a comparison, to compensate 
for the relative ascending node drift it would take about a fuel cost of 56 m/s 
over year to compensate. 

Thus, it is possible to design relative orbits with out-of-plane motion created 
by an inclination change and a chief orbit that is near-polar. However, the equal 
ascending node rate condition must be dropped here to obtain a relative orbit of 
practical value. Periodic maneuvers will be required to compensate for the dQ 
drift. References 20 and 21 present continuous feedback and impulsive control 
schemes respectively in terms of the mean orbit elements. These methods will 
be discussed later in this chapter. For an orbit such as is presented in case 2, 
it would make sense to use the impulsive control scheme where the ascending 
node is correct during the polar region crossings using the out-of-plane burn: 


ESOL RG. “gee = Von aemees (13.165) 





Avne = 





rsin@ 


Note that 6 = w+ f is the true latitude angle. 


13.6.4 Near-Circular Chief Orbit 


As the chief’s orbit eccentricity becomes small, the eccentricity differences com- 
manded by the equal nodal rate condition may cause the relative orbit to become 
very large in the along-track direction. This is clear from the linear mapping of 
differences in e to differences in 7 shown in Eq. (13.159) to be: 


de= 1 5 
e€ 


However, the change in e does not become infinitely large as e — 0. The equal 
nodal rate condition in Eq. (13.155) shows a finite required difference in 7 as e 
goes to zero and 7 goes to one. Using the nonlinear relationship 7 = V1 — e?, 
this finite 67 corresponds to a finite de for a circular orbit. However, these 
eccentricity changes may still result in a relative orbit which is too large for 
practical use. Again, as was the case with near-polar chief orbits, if the out- 
of-plane motion can be produced by a change in node instead of a change in 
inclination angle, then having a chief orbit with a small eccentricity would not 
pose any practical difficulties. 

A numerical simulation is performed to illustrate this behavior. The chief 
orbit elements are shown in Table 13.3. The relative orbit is established using the 
mean orbit element differences of 60 = 0.01 degrees, dw = 0.01 degrees and 6M 
= -0.01 degrees. An inclination angle difference 6i of 0.01 degrees is requested. 
The relative orbits were computed for the three mean chief eccentricities 0.04, 
0.05 and 0.06. 

Figure 13.12(i) compares the resulting three relative orbits. For the case 
where e = 0.06, the requested 62 required a de of 0.000799. The case where 
e = 0.05 resulted in a de of 0.000957 and the case with e = 0.04 resulted in de = 
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0.001191. Clearly the smaller chief eccentricities result in a larger relative orbit 
in the along track direction. 

This general behavior is also illustrated in Figure 13.12(ii) where the required 
de for a 6% of 0.01 degrees are displayed for various chief eccentricities e and 
inclination angles 7. Due to the tani term in the equal nodal rate condition, 
the effect of having small eccentricities is enhances for larger inclination angles. 
The de here were computed using the nonlinear mapping between 7 and e. 
While the required eccentricity for the relative motion orbit does grow large as 
e approaches zero, it reaches a finite limit for a circular chief orbit case and does 
not become infinite. 

This result is interesting in that it states that it is easier to compensate for 
out-of-plane motion induced by 67 if the chief orbit has a larger eccentricity. The 
richer dynamics of having a more eccentric orbit makes it easier to compensate 
for the relative nodal drift condition. 


13.6.5 Relative Argument of Perigee and Mean Anomaly Drift 


To establish the Jz invariant orbits, conditions are established which set the 
relative ascending node rate 6Q and latitude rate 664, equal to zero. While 
this guarantees that the angle between the chief and deputy position vector 
remains constant, it is possible that the argument of perigee and mean anomaly 
differences drift apart. The effect of this is that for chief orbits with non-zero 
eccentricity, the relative orbit geometry swells larger as dw and 6M drift apart 
and then shrinks again as they eventually approach each other. Since the relative 
latitude rate is equal to zero when the two presented J2 constraint conditions 
are satisfied, then we know that 


bw! = —5M! (13.166) 


To compute the relative drift in the argument of perigee, we take the partial 
derivative of Eq. (13.145b). 


Ow! Ow! 
= L 
aE 6L+ On én + 
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ju" 











bi (13.167) 


After substituting the J2 invariant conditions in Eqs. (13.158) and (13.155), the 
relative perigee drift rate is found to be 


dw’ = Ia (tan i(5 cos? i — 1) — 5 sin(2i)) di (13.168) 

The following numerical simulation illustrates the effect of the perigee/mean 
anomaly drift has on the relative orbit geometry. The chief orbit elements are 
the same as are shown in Table 13.3 with an eccentricity set to be 0.05. A mean 
di of 0.01 degrees is prescribed and the mean 62 is set equal to 0.01 degrees. 
The argument of perigee and mean anomaly differences are set equal to 


dw = —dM =0.0, 0.5 or 1.0 degrees 
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The resulting three relative orbits are illustrated in the rotating Hill frame 
in Figure 13.13. As the argument of perigee and mean anomaly differences 
drift apart, the overall relative orbit geometry is expanded without changing 
the shape itself appreciably. Not that the presented orbit has a relatively large 
eccentricity of 0.05. If the eccentricity were closer to zero, then the effect of the 
perigee/mean anomaly drift on the relative orbit geometry would be even less. 
At the limiting case where the chief orbit becomes circular, the perigee/mean 
anomaly drift would have no effect on the relative geometry. 
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Figure 13.13: Relative Orbits in LVLH Frames for Three Different Ar- 
gument of Perigee and Mean Anomaly Differences 


While this drift in dw and 6M is an effect that may have to be periodically 
compensated for, the argument of perigee and mean anomaly drift occurs very 
slowly. For the presented numerical simulation, the dw had only drifted 0.05 
degrees after 45 revolutions (roughly three days). Thus, for dw to drift the 1.0 
degrees shown in Figure 13.13, it would take at approximately 60 days. 

To correct such specific orbit element differences, Reference 21 developed 
an impulsive feedback control scheme with the mean orbit element errors as 
the feedback quantity. While this scheme is able to correct any types of orbit 
element errors, the w and M correction are of interest to the present problem. 
Let Av,, a orbit radial thrust performed at perigee, and Av,, the orbit radial 
thrust performed at apogee. In order to correct a specific Aw = —AWM error, 
the following control is used. 


2 
ip iP (ca ree. 1) Aw (13.169) 
P 4 n 
_og\2 
Avr, = (2 - 1) Aw (13.170) 


The advantage of this impulsive firing scheme is that only the osculating w 
and M are adjusted in a near-optimal manner. Reference 21 goes into further 
details describing how this scheme can also be used to correct for mean orbit 
element errors. 
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13.6.6 Fuel Consumption Prediction 


As has been shown in the previous discussion, at times it may be beneficial to 
relax the two constraints on the mean orbit elements in order to obtain a relative 
orbit solution which is of practical value. We would like to present convenient 
formulas which allow us to predict the fuel cost in terms of Av’s that must 
be applied to cancel any Jz induced drift if the orbit elements a, e and i do 
not perfectly match the conditions in Eqs. (13.155) and (13.158). To perform 
this analysis, it is convenient to use the dimensional mean orbit element drift 
equations. 


: 3 r2 n ; 

Q= mig ta aee (13.171) 
Se 2. 

v= A aga 4 1) (13.172) 
Ape 3_r2n of 


The methodology to compute the fuel cost to combat the Jz induced drift 
will be the same for all the cases. First, we will compute how much drift the 
momenta orbit element differences 6a, de and 67 will cause over one orbit. Then, 
using impulsive control, we are able to provide an estimate of what Av would be 
required to cancel the Jz induced drift. Note that these fuel estimates will not 
be precise predictions, but rather they provide a convenient method to quickly 
assess how much fuel would be required to combat the Jz perturbation if the 
orbit element differences are not set at their ideal Jj invariant values. 


Ascending Node Relative Drift Correction Cost Estimate 


First, we find an estimate of the fuel required to control the Jz induced ascending 
node drift. The derivative of Eq. (13.171) is used to compute the relative nodal 
drift 5Q. Note that advantage is taken here of the fact that the semi-major axis 
differences da are assumed to be of order J2 and are thus ignored here as higher 
order terms. 

Scone 


60 = = Jo“£— (nsini 51 + 4cosi dn) (13.174) 
2° G2 


The orbit period P of the chief satellite is given by 


_ an 


P (13.175) 


n 
The Jz induced drift in the ascending node over one orbit period is then given 
by 

2 


AQoroit = 60+ P = 3.Jan 2 (sini 54+ 4 cosi 6m) (13.176) 
a“) 
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Eq. (13.176) provides an estimate of the amount of ascending node correction 
that would be required per orbit. To compute what Av would be required 
to perform these corrections, the impulsive control scheme developed in Refer- 
ence 21 is used here. The impulses developed in this control law correct specific 
orbit element errors are based on Gauss’ variational equations.” The ideal time 
to perform a node correction is during the polar crossings where 6 = +90 de- 
grees. Firing an impulse Avy, in the orbit normal direction, the following node 
correction is achieved: 





Aun = Ah (13.177) 








Note that r;, is the orbit radius at 6 = +90 degrees. After substituting Eq. (13.176) 
into Eq. (13.177), and performing several simplifications, the following fuel es- 
timate is found to counter a Jz induced nodal drift. 


2 
Avy, = 3Jon—£— sini (n sini 64+ 4cosi dn) (13.178) 
Th 1) 


Note that this Av estimate is the fuel required per orbit. To find a yearly fuel 
budget estimate, this figure needs to be multiplied by the number of orbits that 
occur in one year. 

As expected, if the mean orbit element differences 61 and 67 satisfy the equal 
nodal rate condition in Eq. (13.155), then the predicted fuel budget is zero. 
Note that the actual fuel budget would not be zero though. This is because 
several first order approximations were made in developing the two constraints 
in Eqs. (13.155) and (13.158). 

Eq. (13.178) does provide a very convenient method to quickly estimate the 
fuel budget if the Jo invariant conditions are not setup perfectly. Assume the 
relative orbit is designed using the linear CW equations. Here the chief orbit 
is circular and we set the inclination angle equal to 70 degrees and the semi- 
major axis equal to 7000 km. To obtain an out-of-plane motion of roughly one 
kilometer, a 02 of 0.01 degrees is required. Using Eq. (13.178), this leads to 
an annual fuel budget estimate of 43.6 m/s solely to correct for the relative 
ascending node drift. A cost which could be avoided if the Jz perturbation is 
taking into account when designing the relative orbit. 


Argument of Perigee and Mean Anomaly Relative Drift Correction Cost 
Estimate 


After having found a fuel budget estimate to correct the relative nodal drift, fuel 
budget estimates are now developed to correct for both the relative argument of 
perigee drift and mean anomaly drift. Taking the derivative of Eq. (13.172) and 
making use again of the fact that da is of the order of Jz, the relative argument 
of perigee drift rate is expressed as 


2 
fg aty te (5nsin(2é)5i + 4 (5 cos? i — 1)én) (13.179) 
4 “a? n> 
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Using Eq. (13.175), the perigee drift over one orbit is estimated to be 


3 2 
Nis cO. Sagi Ia $ (5n sin(2é)5i + 4 (5cos*i—1)5n) (13.180) 
nt a 
The mean anomaly drift over orbit is computed in an analogous manner. 
Note, however, that here da appears without being multiplied by Jz and is thus 
retained. 


; 37 Or 2 n ; aks Q . 
Alorbit -61-T= at — 7 2 a2 xf (nsin(2i)6i _ (1 —3cos i)dn) 
(13.181) 


Again, note that Eqs. (13.180) and (13.181) provide angular drift estimates for 
one orbit period. To compute the annual drift, these figures would be multiplied 
by the number of orbit period in a year. 

To compute Av’s necessary to perform the required Aw and AM corrections, 
the two impulse technique presented in Reference 21 is used. Here an orbit radial 
thrust is applied at both perigee and apogee to achieve the desired orbit element 
corrections in a near-optimal manner and without affecting the remaining orbit 
elements. Using this method, the two Av are then computed through 


2 
Av, =" (Ce as + am) (13.182) 
7 
_4)2 
Rips (as + am) (13.183) 
7 


where Aw and AM are computed through Eqs. (13.180) and (13.181) respec- 
tively. The total fuel estimate required to control either relative argument of 
perigee drift, relative mean anomaly drift or both is then computed as 


Ava,m = |Avr,| + |Avr,| (13.184) 


Relative Mean Latitude Drift Correction Cost Estimate 


While Eq. (13.184) is convenient to estimate the fuel budget to correct for g or 
1 relative drifts, for the formation flying problem this is of lesser importance. 
What is more critical is what is the fuel budget to combat the latitude drift, 
i.e. the sum of both the relative perigee and mean anomaly drift. For nearly 
circular orbits the argument of perigee and mean anomaly can drift apart with 
negligible effect on the relative orbit geometry, as long the sum of their drifts is 
zero. In this section we will provide a fuel budget estimate to control the relative 
latitude drift. The amount of mean latitude drift rate is computed through 


66m = 60 +5M (13.185) 


To estimate how much fuel is required to correct a latitude error, it is as- 
sumed that a Av is applied to change the semi-major axis a (and thus the orbit 
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period) which will speed up or slow down the satellite such that it correct the 
00M error over one orbit. At the end of the correction, a second such 6a adjust- 
ment must be made to reinsert the satellite in the previous orbit. From Gauss’ 
variational equation in Eq. (11.153a), the required Av for a given da is 


h 


n fl—e 
= — §q = —,/ —— 13.1 
v alte) BA Tae” (13.186) 


if the Av is applied at perigee. To relative the change in semi-major axis da to 
the corresponding change in orbit period oP, we differentiate Eq. (13.175) and 
make use of n = \/j1/a°. 


2a 6P 
a 13.1 
a= Tp (13.187) 
The final step is to relate the latitude drift amount 60, per orbit to the required 
orbit period change 6P which will accomplish this correction. This is found 
through 
00m, 


orbit 


= 604 -P=n-6P (13.188) 


Substituting Eqs. (13.187) and (13.188) into Eq. (13.186), a fuel budget estimate 
to correct the per orbit latitude drift is 





Ou (13.189) 


If the da, de and 0% differences satisfy the conditions in Eqs. (13.155) and 
(13.158), then the latitude drift 6@;, becomes zero, resulting in a zero fuel 
budget estimate. 


13.7 Relative Orbit Control Methods 


This section develops various relative orbit control laws. Typically, this feedback 
control laws operates on the orbit elements. Gauss’ variational equations of 
motion, shown in Eq. (11.153), provide a convenient set of equations relating 
the effect of a control acceleration vector u to the osculating orbit element time 
derivatives.?? They are repeated here for convenience: 








7 7 ie (esin fur+ a) (13.190a) 
= = 3 (psin fu, + ((p +1) cos f + re) ue) (13.190b) 
. a ree (13.190c) 
aD, reine (13.1904) 


U 
dt hsini ” 
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dw 1 rsin @cosi 


ae he [—pcos fu, + (p +r) sin fue] — hein; Ue (13.190e) 
dM 
ant x [(pcos f — 2re)uy — (p +r) sin fug] (13.190f) 


where the control acceleration vector wu is written in the deputy Hill frame 
components as 


u = (up, U9, Un) (13.191) 


with u, pointing radially away from Earth, u,;, being aligned with the orbit 
angular momentum vector and ug being orthogonal to the previous two direc- 
tions. The parameter f is the true anomaly, r is the scalar orbit radius, p is the 
semilatus rectum and the true latitude angle is 0 = w+ f. 


13.7.1 Mean Orbit Element Continuous Feedback Control Laws 


Since the relative orbit is being described in terms of relative differences in 
mean orbit elements when establishing Jz invariant relative orbits, we examine 
a feedback law in terms of mean orbit elements instead of the more traditional 
approach of feeding back position and velocity vector errors. Doing so will allow 
us to control and correct specific orbit element errors. Not all orbit position 
errors are created equal. An error in the ascending node should be controlled 
at a different time in the orbit than an error in the inclination angle. 
The mean angular velocity n is defined as 


n=,/4 (13.192) 


Note that Gauss’ variational equations in Eq. (13.190) were derived for Keplerian 
motion. In matrix form they are expressed as 


€osc — (0,0,0,0,0,n)7 + [B(€osc)]u (13.193) 


with €ysc = (a,e,i,,w, M)" being the osculating orbit element vector and the 
6 x 3 control influence matrix [B] being defined as 





2a7e sin f 2a2p 4 
h he 
pain f kph) soe re 0 
h h 
0 0 reos? 
_ pcos f (ptr) sin f nein code 
n(p cos Be one) a(n) sin f are 
Se ew oy “ao wea 


Let the vector e = (a, €,t,2,w, M)* be the classical mean orbit element vector, 
and 


e€ = E(€osc) (13.195) 
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be an analytical transformation from the osculating orbit elements e55. to the 
mean elements e. In this study, a first order truncation of Brouwer’s analyti- 
cal satellite solution is used as shown in Appendix G.!" Incorporating the J2 
influence, we write Gauss’ variational equations for the mean motion as 


0g 


J€ ose 





T 
e= [Atel] + | so] (Blend (13.196) 


with the 6 x 1 plant matrix [A(e)] being defined as 


One 


[A(e)] = =f, (22) neosi (13.197) 


2 
3 Jo (=) n(5 cos? i — 1) 





2 
n+3J2 (“) nn(3.cos? i — 1) 
Studying Brouwer’s transformation between osculating and mean orbit ele- 
ments, it is evident that the matrix [0€/O€ osc] is approximately a 6 x 6 identity 
matrix with the off-diagonal terms being of order Jz or smaller. Therefore, for 
the purposes of developing a feedback control law, it is reasonable to approxi- 
mate the mean orbit element rate equation as 


é = [A(e)] + [B(e)]u (13.198) 


The plant matrix [A] in Eq. (13.197) rigorously describes the behavior of the 
mean orbit elements. As is clearly seen here, the Jz perturbation has no secular 
effect on the elements a, e and i. The control influence matrix [B], devel- 
oped in Gauss’ variational equations shown in Eq. (13.190), allows us to com- 
pute a change in osculating orbit elements due to a control acceleration vector 
uw. It is assumed that these osculating orbit element changes, as indicated in 
Eq. (13.198), are directly reflected in corresponding mean orbit element changes. 
For example, if a thrust is applied to change the osculating inclination angle by 
one degree, then the corresponding mean inclination angle is also changed by one 
degree. The errors introduced by this assumption will be of order Jz. Further, 
since the difference in osculating and mean orbit elements is relatively small for 
Jz perturbations, the numerical difference in computing [B] using osculating or 
mean orbit elements is typically negligible. In our use of Eq. (13.198) below, we 
assume that the [B(e)] matrix is computed using mean orbit elements. 

Let us assume that the relative orbit was set up such that the deputy satel- 
lite has a specific mean orbit element difference Ae relative to the chief mean 
orbit elements e;. At any instance, the desired deputy satellite location eg is 
expressed in terms of mean orbit elements as 


€q = €. + Ae (13.199) 
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Note that Ae is a fixed mean orbit element difference. Therefore it doesn’t 
matter if the chief orbit was slightly perturbed by other influences such as 
atmospheric or solar drag. The relative orbit is always defined as a specific 
difference relative to the current chief mean orbit elements, in order to maintain 
a specific relative motion. 


Given the true set of mean orbit elements é, of the deputy satellite, the 
relative orbit tracking error de is expressed in terms of mean orbit elements as 


de = €g — eq (13.200) 


The Lyapunov control theory, presented in Chapter 7, is used here to develop 
a feedback control law. We define the Lyapunov function V as a positive definite 
measure of the mean orbit element tracking error de. 


V(5e) = se" be (13.201) 


Assuming the desired relative orbits are Jz invariant (i.e. are natural, unforced 
solutions of the relative equations of motion), the derivative of eq is 


éq = [A(ea)| (13.202) 
where no control is required to maintain this evolving orbit. Clearly non-J2 
perturbations are being treated as minor disturbances and are not considered 


in Eq. (13.202). Taking the derivative of V and substituting Eqs. (13.198) and 
(13.200), we find 


V = de" dé = de? ({A(éa)] — [A(ea)] + [B(e)] us) (13.203) 
Setting V equal to the negative definite quantity 
V = —de" [Plée (13.204) 
where [P] is a positive definite feedback gain matrix, we arrive at the following 
control constraint for Lyapunov stability of the closed-loop departure motion 
dynamics. 


[Blu = —([A(éa)] — [A(ea)]) — [Ploe (13.205) 


Note that [P] does not have to be a constant matrix. In fact, later on, we 
will make use of this fact to encourage certain orbit element corrections to 
occur during particular phases of the orbit. Using Eq. (13.194) to study the 
effectiveness of the control vector to influence a particular orbit element, one 
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choice is to give the feedback gain matrix [P] the following diagonal form 


N 


Py, = Pao + Pai cos f 13.206a 





( 
P22 = Peo + Pei cos” f ( 
P33 = Pio + Pi, cos® 6 
Pas = Poo + Par sin’ 0 
P55 = Po + Por sin™ f 


Pe6 = Pyo + Pui sin’ f 


13.206b 
13.206¢ 
13.206d 
13.206¢e 
13.206f 
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) 
( ) 
( ) 
with N being an even integer. The various feedback gains are now at a maximum 
whenever the corresponding orbit elements are the most controllable, and at a 
minimum or essentially zero when they are the least controllable. The size of 
N is chosen such that the Pj, gain influence drops off and rises sufficiently 
fast. Clearly there are an infinity of heuristic feedback gain logics that could be 
used here which belong to the stabilizing family. We could alternatively pose 
an optimization problem and optimize [P(t)] to extremize some performance 
measure. For illustration purposes, we simply choose several stable controllers 
in this text. 

One issue of writing the satellite equations of motion in first-order form in 
Eq. (13.198) becomes quickly apparent. Since the control vector only has three 
components, and we are attempting to control six orbit elements, we can’t 
directly solve the control constraint equation in Eq. (13.205) for the control 
vector wu. Since the system of equations is over determined, we employ a least- 
square type inverse to solve for wu. 

u = ((B]*[B))* [B]? (([A(éa)] - [Alea)]) + [Plée) (13.207) 
Due to the imprecise nature of the least-squares inverse, the resulting control 
law is no longer guaranteed to satisfy the stability constraint in Eq. (13.205). 
However, as numerical simulations show, this control law does successfully cancel 
mean element tracking errors and reestablish the desired relative orbit. 

Other control methods could be employed to control the mean element track- 
ing error defined in Eq. (13.200). The advantage of this method is the presence 
of the time varying 6 x 6 feedback gain matrix [P]. In particular, it allows us 
to selectively cancel particular orbit element errors at any time. A classical 
example is correcting for ascending node and inclination angle errors. Studying 
Eq. (13.190) or (13.194), it is evident that the feedback gain for dQ should be 
large whenever 6 = +90 degrees and near-zero whenever 6 = 0,180 degrees. 
Near the equator it is known that the control effort required to correct for a dQ 
would be very large. Therefore nodal corrections are best performed near the 
polar regions. Analogously, the inclination angle changes are best performed 
near the equator, with little or no inclination corrections being done near the 
polar region. Depending on the chief orbit elements, similar statements can 
be made for the remaining orbit elements. The result is that one can easily 
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design a variable gain control law which will wait for the satellite to be in an 
advantageous position within the orbit before correcting certain orbit element 
errors. Note that this approach enables one to simultaneously control the long 
term secular orbital dynamics (by considering orbit element control and using 
mean orbit elements) and to effectively time the control corrections during each 
orbit to “cooperate with the physics” of orbital dynamics. 

The feedback law in Eq. (13.207) contains a term computing the difference 
in natural mean element rates between the actual mean orbit element vector 
€, of the deputy satellite and the desired mean orbit element vector eg. If the 
difference in actual and desired mean orbit elements of the deputy is small, as 
is typically the case with spacecraft formation flying, then it can be shown that 
this difference is very small and has a negligible influence on the control law. 
Linearizing this difference about the desired mean orbit element vector eg, we 
find 


de = [A*(e,)]de (13.208) 


ed 


[A(éq)] — [A(ea)] ~ | 





Using Eq. (13.208), we are able to write the linearized mean element error 
dynamics as 


dé ~ [A*(eq)|de + [Ble)]u (13.209) 


Note that the plant matrix is time dependent due to eg, and the control influence 
matrix is state dependent. Because [A] only depends on the mean a, e and i 
parameters, the 6 x 6 matrix [A*] has block structure: 


[A*(ea)] = bey | (13.210) 


Substituting Eq. (13.208) back into the control law in Eq. (13.207), we approx- 
imate wu as 


u ~ — ([B]"[B])  [B]” ([A*(ea)] + [P]) 6e (13.211) 


Taking the partial derivatives of Eq. (13.197) with respect to e, the submatrix 
[A5,] is found to be 


Zt cosi —6e-S cosi Sesini 
[A3,] = —= He cos? i — 1) 3e 5 (5 cos?i-—1) —esin(2i) 
—# [n + $e(3 cos? i — 1)] 3¢€;4(3 cos? i — 1) —2esin(2i) 


(13.212) 


with the small parameter € being defined as 


2 
e= dp (2) n (13.213) 
p 
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An approximate analysis of the [A3,] matrix entry magnitudes in terms of metric 
units yields the following. Because both Jz and n are of order 107%, and req/p 
is of order 1, the parameter € is of order 107°. Most entries of [A3,] contain € 
multiplied by either e, a small quantity of order 10~? or smaller, or divided by 
a, a large quantity of order 10°. These entries are then at least of order 107° or 
smaller. The largest entries contain only € or n/a. Either one is of order 107°. 
Therefore, studying Eq. (13.211) shows that unless the feedback gain matrix 
[P] is of order 10~° or less, the [A*] matrix has a negligible influence on the 
control performance. In fact, if the feedback gain matrix [P] is at least two or 
more magnitudes larger than the [A*] matrix, the ([A(éa)] — [A(ea)]) term can 
be dropped from the control law without any apparent performance loss. 

Dropping the ({A(éz)] — [A(ea)]) term from the mean element feedback law, 
we are able to provide a rigorous stability proof for the special case where the 
feedback gain matrix [P] is simply a positive constant scalar P. 


u=—P([B)"[B]) [B\76e (13.214) 


Note that restraining the feedback gain to be a constant scalar would have a 
negative impact on the control performance, since it is no longer possible to use 
the celestial mechanics insight to guide when certain orbit elements should be 
corrected. But, this proof does provide some more analytical confidence in the 
control law and could be of use when only certain orbit elements have to be 
controlled.?? We define a modified time dependent Lyapunov function V(de, t) 


as?3 


V (de, t) = ~(a1 + age *")de7 de (13.215) 


NIlR 


with both a; and a2 being positive constants. Due to having V (de, t) explicitly 
depend on time, further steps are required in proving that V is positive or 
negative definite. This Lyapunov function V(de,t) is positive definite since 
there exists a time-invariant positive definite Vo(de) such that?4 


V(6e,t) > be7 be = Vo(6e) (13.216) 


Further, this V is decrescent since there exists a time-invariant positive definite 
function Vi (de) such that?4 


Qa, + a2 


V(6e,t) < de de = Vi (de) (13.217) 


Since V(de,t) — oo if |ée| — oo it is also radially unbounded. Taking the 
derivative of Eq. (13.215) and making use of dé = [B(e)]u and Eq. (13.214), we 
find 


V (de, t) = — agaze~°?* de" de 


13.218 
— (ay + age **) Pde" [B]({[B]7 [B])~ [|B] oe ( ) 
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Figure 13.14: Mean Element Control Illustration 
























































This time dependent function is negative definite since there exists a time- 
invariant negative definite function 


Vo(de) = —aza36e" de — a, Pde" [B]({B]7 [B])~![B]? de (13.219) 
such that? 
V (de, t) < Vo(de) (13.220) 


Since V(de,t) is positive definite, decrescent and radially unbounded, while 
V (de, t) is negative definite, the simplified control in Eq. (13.214) provides global 
uniform asymptotic stability under the assumption that the feedback gain P is 
large enough such that the term ([A(éa)] — [A(ea)]) can be dropped. Again, it 
should be noted thought that only having a scalar feedback gain P may provide 
un-acceptable fuel cost since the feedback control law may try to compensate 
for orbit element errors when it is very inefficient to do so. 

A schematic layout of the mean element control is shown in Figure 13.14. 
Inertial position and velocity vectors are assumed to be available for both the 
chief and deputy satellite. After transforming both sets of vectors into corre- 
sponding mean orbit element vectors, the desired deputy mean elements are 
computed through a specified orbit element difference Ae relative to the chief 
satellite. The tracking error de is then computed as the difference between the 
desired and actual deputy mean orbit elements. As mentioned earlier, the first 
order transformation used in this study to transform back and forth between 
osculating and mean orbit elements is not perfect. Taking a cartesian position 
and velocity vector, transforming first to mean elements and then back to carte- 
sian coordinates can result in position differences in the dozens of meters. This 
is not a problem for typical orbit applications. However, for spacecraft forma- 
tion flying, where the satellite relative orbit is to be controlled very precisely, 
this transformation error is significant. In the control strategy presented in 
Figure 13.14, both sets of mean elements are computed from inertial cartesian 
coordinates. While there is a minor error associated with this transformation, 
the error will be roughly the same for both sets of coordinates since the cartesian 
coordinates are relatively close to begin with. Because a difference in mean or- 
bit elements is fed back, these transformation errors are found to approximately 
cancel each other and do not degrade the controller performance. Of course, 
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this transformation error could be further reduced by expanding the analytic 
orbit solution to higher order. However, even here it is beneficial to always deal 
with differences in orbit elements to achieve higher numerical accuracy. 


13.7.2 Cartesian Coordinate Continuous Feedback Control Law 


Traditional feedback laws depend on cartesian position and velocity error vector 
measurements. A nonlinear cartesian coordinate feedback law is presented which 
illustrates the steps necessary to track a prescribed relative orbit expressed in 
terms of mean orbit element differences. A related nonlinear feedback law is 
presented in Ref. 25. 

The inertial equations of motion of the chief satellite r; and deputy satellite 
T2 are 


Fe = f (re) (13.221) 
#a=f(ra)tu (13.222) 


where the chief satellite is assumed to be in a free, uncontrolled orbit and only 
the deputy satellite is being controlled to maintain the desired relative orbit. 
The vector function f(r) contains the gravitational acceleration. Expressing 
the inertial position vector in terms of inertial components r = (x,y,z) and 
including the Jz perturbation, this function is defined as 


is af 5x (7), —2 
f(r) = -4 |r — as (=) By (2)? -y (13.223) 
5z (2)° — 3z 


where r is the scalar orbit radius. Let rg, be the desired inertial position vector 
of the deputy satellite for a Jz invariant relative orbit. The position tracking 
error 6r is then defined as 


or =Ta-—Tdg (13.224) 


Using this error vector and its derivative, the positive definite Lyapunov function 
V is defined as 


V(6r, or) = soe + 5orT [Kor (13.225) 


where [K;] is a positive definite 3 x 3 position feedback gain matrix. Taking the 
derivative of V we find 


V =6r" (#4 — 4, + [Ki Jor) (13.226) 


Substituting Eq. (13.222) and making use of the fact that the desired relative 
orbit is Jz invariant (i.e. control free), the Lyapunov rate is written as 


V =r" (f (ra) — f(ra,) + ut [Ki]or) (13.227) 
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Enforcing V to be equal to the negative definite quantity 
V = —6r7" [Ke]or (13.228) 


where [9] is a positive definite 3 x 3 velocity feedback gain matrix, the asymp- 
totically stabilizing control law wu is found to be 


u=-—(f(ra) — f(ra,)) — [Ki lor — [Ke]or (13.229) 


Note that this control law controls the inertial deputy orbit directly. The orbit 
errors 6r are only the difference between the desired and actual inertial deputy 
orbit. This control law can be used for formation flying control by having the 
desired deputy position rz, be defined relative to the chief orbit. As is, the 
feedback control law in (13.229) could be also be used to maintain the inertial 
orbit of a single satellite. The asymptotic stability property of this control law 
can be verified by checking the higher order derivatives of V on the set where 
V is zero (i.e. evaluated at 6% = 0).?° The first non-zero higher derivative of V 
on this set is found to be the third derivative 


V (6% = 0) = —6r? [Ky]? [Ka][Ki Jor < 0 (13.230) 


which is negative definite in dr. Thus the order of the first non-zero derivative 
is odd and the control law is asymptotically stabilizing. 

Where the mean orbit element feedback law feeds back a difference in the 
natural orbit element rates, the cartesian coordinate feedback law in Eq. (13.229) 
feeds back a difference in gravitational accelerations. Linearizing this difference 
about the desired motion rq,(t) we find 


f(ra) —f (ray) ~ ES or = [F(ra,)|or (13.231) 


Tdg 





Using Eq. (13.231), the closed-loop dynamics are now written in the linear form 
as 


Or ~ [F(ra,)|or + u (13.232) 
and the control law is linearized as 
ux —([F(raq)] + [Ki))or — [2] 67 (13.233) 


The matrix [F] can be written as [F] = [Fepter] + [Fy] where [F Kepler] is the 
term due to the inverse square gravitational attraction and [Fy] is the term 
due to the Jz perturbation. Doing a similar dimensional study of [FKepier] and 
[F'7,], as for [A*] earlier, the matrix [Fxepier] is found to be of order y/r and 
[Fj,| of order Jou/r?. Since both Jo and 1/r are roughly 107°, this means 
that [F),] is on the order of 107° smaller than [Fepier]. This means that 
excluding the Jy term in the f(r) calculation will have a negligible effect on 
the performance. Therefore the largest component of [F] is of order p:/r = 104 
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Figure 13.15: Tracking Error Computation Logic for Cartesian Coordi- 
nate Feedback Control 
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in metric units. For the cartesian feedback law, feeding back the difference 
in gravitational accelerations has a large influence on the performance. For 
example, if the gains are very small to allow the maneuver to take several orbit 
revolutions, then the control effort will still be large due to this gravitational 
acceleration difference term. This is in contrast to the mean orbit element 
feedback law where the maneuvers can easily be stretched over several orbit 
revolutions. 

A critical detail in this cartesian coordinate feedback law is how to com- 
pute the desired deputy position and velocity vectors, because the relative orbit 
trajectory is described in terms of mean orbit element differences relative to 
the chief orbit. Figure 13.15 illustrates this process. After translating the 
chief cartesian coordinates into corresponding mean orbit elements, the desired 
deputy position and velocity vectors are computed by first adding the desired 
mean orbit element difference vector Ae and then transforming these desired el- 
ements back to cartesian space. However, if these desired inertial deputy states 
are differenced with the actual inertial deputy states, serious numerical difficul- 
ties may arise. The reason for this is the transformation error that occurs when 
mapping between osculating and mean orbit elements. The closed loop position 
errors will stop decaying once the accuracy of this transformation is reached. 
To avoid this limitation, we don’t use the actual states of the deputy when 
computing the tracking error. Instead, we map these states first to mean orbit 
elements and then back to cartesian coordinates before differencing them with 
the desires states. With the difference between the chief and deputy position and 
velocity vectors being very small, the transformation error due to the forward 
and backward mapping will be essentially identical and cancel themselves when 
being differenced. This qualitative observation is consistent with our numerical 
experiments. The result is a nonlinear cartesian coordinate feedback law that 
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is able to establish the Jz invariant orbit and overcome some of the limitations 
of having a first-order transformation between the osculating and mean orbit 
elements. 


13.7.3 Impulsive Feedback Control Law 


The previous two formation flying control law provide a continuous thrust vector 
to cancel any relative orbit errors. This section develops an impulsive control 
scheme to control the relative orbit. Instead of continuously controlling the 
relative orbit errors, the tracking errors will only be controlled at specific periods 
within the orbit. This impulsive feedback control law was born out of the quest 
to find a method to correct for the argument of perigee and mean anomaly drifts 
experienced by J2 invariant orbits, while minimally impacting the remaining 
orbit elements. While the presented method is attractive to correct specific sets 
of orbit elements, it is also possible to use this method to correct for arbitrary 
relative orbit errors. Further, the results of this sections were used earlier in the 
development of control effort estimates for maintaining Jz invariant orbits. 

Gauss’ variational equations are used again in this development to derive the 
required control law. Studying the dQ/dt and di/dt expressions in Eq. (13.190), 
it is evident that the individual ascending node or inclination angles are adjusted 
best when the spacecraft passes through either the polar or the equatorial regions 
respectively. However, if both an inclination angle and nodal correction are to 
be performed, it is more fuel efficient to perform both corrections with one 
impulse only. Both elements are adjusted with an orbit normal impulsive Ava; 
as shown in Eq. (13.190). The corresponding inclination angle and ascending 
node corrections are given by 








Ai= reese Aon (13.234) 
Koa a, (13.235) 
hsini 


Dividing Eq. (13.235) by (13.234), the critical true latitude angle 0, at which 
to perform this orbit normal thrusting maneuver is 


AQ. sini 


6, = arcta 
Cc r n Ai 


(13.236) 
Squaring and summing Eggs. (13.234) and (13.235), the required Av; to perform 
the desired inclination correction Az and ascending node correction AQ is 


h 
Avp;, = —V Ai? + AO? sin 7? (13.237) 
r 


Note that applying this Av, only affects the orbit elements 7, 2 and w. This 
cross-coupling between the (i,Q) correction and w is the only coupling between 
osculating orbit element set corrections in this firing scheme. Note that while 
there always exists two possible critical true latitude angles 6. from Eq. (13.236), 
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only the solution corresponding to a positive Av, is used in this control method. 
Thus (i, 22) are only corrected at one point in the orbit. 

Substituting the Av, in Eq. (13.235) into Eq. (13.190d), the AQ correction 
results in the following Aw change: 


Aw(Avp) = — cosiAQ (13.238) 


This secondary effect will be taken into account when specifying the impulse 
required to correct the argument of perigee. 

The argument of perigee and the mean anomaly are also corrected together 
together as an orbit element pair, but with two impulsive maneuvers over one 
orbit. Each impulsive thrust is in the orbit radial direction only and is applied 
at both the orbit perigee and apogee. Let Av,, be the radial impulse applied 
at perigee and Av, be the impulse at apogee. Computed over one orbit, and 
taking into account that an ascending node correction AQ could be occurring 
(which causes an additional change in w), the Av,, and Av,, impulses cause 
the following osculating orbit element changes. 


1 

Aw= 7 o(—P(Avr, — Av,,,) — AQ cos i) (13.239) 
e€ 

AM = i ((p = 2rpe)Av,, _ (p+ 2rae)Avr,) (13.240) 
€ 


with 7 = V1 — e?. To solve these two equations for the radial Av’s, the following 
identities are useful 











p—2rpe=p (13.241a) 
+e 
1+ 
p—2rae = py>— (13.241b) 
—e 


along with h/p = na/n. Substituting these expressions into Eqs. (13.239) and 
(13.240) we find 
Av,, — Avr, = —(Aw + AQcosé) (13.242) 
0 
(1 — e)?Av,,, — (1+ e)?Av,, = naecAM (13.243) 


Solving these two equations for the required radial impulses to achieve a desired 
Aw and AM we find 
1 2 
Avr, = > (a. +AQ cosi) +AM) (13.244) 
0 
na 


_ 4)2 
Av, => (Sa. + AQcosi) + am) (13.245) 
n 


Note that if a AO correction is performed during this orbit, then its effect is 
immediately taken into account in the above two equations. 
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The argument of perigee and mean anomaly corrections, provided by Eqs. (13.244) 
and (13.245), are convenient to compensate for the natural secular drift in these 
orbit elements that will occur with the J2-invariant orbit presented in Refer- 
ence 19. Only w and M of the six orbit elements will not have an equal relative 
drift rate, but rather their sum will. This relative drift difference is not very 
large, but depending on the tolerances of the relative orbit it will have to be 
compensated for periodically. Further, the smaller the eccentricity of the or- 
bit, the less effect the relative drift of w and M will have on the orbit geometry. 
However, Eqs. (13.244) and (13.245) provide an impulsive control method which 
is able to directly readjust the argument of perigee and mean anomaly while 
minimally affecting the other osculating orbit elements. 

The remaining two orbit elements to be corrected are the semi-major axis a 
and the eccentricity e. As is the case with the argument of perigee and mean 
anomaly corrections, the semi-major axis and eccentricity are adjusted together 
through two impulsive maneuvers over one orbit. However, these impulsive 
thrusts are fired in the tangential ug direction. One impulsive correction Ave, 
is fired at perigee and the other impulse Avg, is fired at apogee. With this 
firing sequence a and e are adjusted efficiently and without disturbing the other 
osculating orbit elements. From Eq. (13.190), the a and e corrections over one 
orbit are 


2 2 
NGS (Lars, 4 Pav.) (13.246) 
h \rp Ta 
1 
Ae= -(( + Pp + Tpe)Ave, + (—p- ra + rae)Avo, ) (13.247) 


Note that in deriving Eqs. (13.246) and (13.247) it is assumed that the orbit 
corrections Aa and Ae are relatively small. Otherwise a and e could not be 
held constant during the two maneuvers. To solve these two equations for the 
tangential Av’s, the following identities are used. 


Dp + Tp + Tye — 2p (13.248) 
tiie drt ac Op (13.249) 





Eqs. (13.246) and (13.247) are now rewritten as 


2 

(1+ e)Avg, + (1 — e)Ave, = Aa (13.250) 
a 

Ave, — Ave, = La (13.251) 
2p 


Using h/a = nan, with n = V1 — e?, the required tangential impulses are found 
to be 





nan {Aa Ae 
Ave. = — {( — 13.252 
w, = (= + =) (13.252) 


hep (= ae ) (13.253) 
4 a l—e 
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Note that in both the (w, M) and (a, e) corrections, the sequence of impulsive 
maneuvers over an orbit is irrelevant. The first maneuver may occur at either 
perigee or apogee. 

To implement these impulsive Av’s, the mean orbit element errors are estab- 
lished at some arbitrary point in the orbit, and are then held constant during 
the orbit while appropriate Av’s are applied as discussed earlier. This impul- 
sive firing scheme assumes that all the mean orbit element errors will remain 
constant over an orbit. If the a, e and 7 elements do not satisfy the Jz invariant 
conditions, then 2, w and M will experience some J2 induced secular relative 
drift. However, this drift is relatively small over an orbit and can be ignored. 
The impulsive feedback control will correct, or at least substantially reduce, any 
remaining mean orbit element errors during the following orbit. The exception 
is if the deputy semi-major axis is substantially different from that of the chief. 
In this case the different orbit periods will cause the mean anomaly to exhibit 
substantial relative drift over one orbit. In this case it cannot be assumed that 
AM is constant over an orbit. Thus, the (w, M) corrections do not begin until 
the second orbit. Doing this allows the a, e and i variables to be corrected 
during the first obit, which will set the orbit periods equal between deputy and 
chief satellite. During further orbits, any remaining relative mean anomaly er- 
rors will remain constant over an orbit. If the (w,M) corrections are applied 
during the first orbit with a large semi-major axis error present, then the im- 
pulsive feedback control law still corrects the relative orbit. However, the fuel 
cost typically increases since incorrect (w, MM) corrections are performed during 
the first orbit. 

Since it is advantageous to describe the relative orbit in terms of orbit el- 
ement differences of the deputy satellite relative to the chief satellite, this im- 
pulsive firing sequence is a convenient method to correct orbit errors from the 
desired orbit element differences. If only one or two elements are to be adjusted, 
then this control solution is essentially optimal. If several orbit elements are to 
be corrected, then preliminary studies have shown this method to still yield a 
near-optimal solution with a fuel cost increase of only a few percent over the 
multi-impulse optimal solution. The advantage of this method is that through 
its simplicity and low computational overhead, it lends itself well to be imple- 
mented in an autonomous manner. Little ground support would be required 
for a cluster of spacecraft to maintain their formation as long as they are able 
to sense their inertial orbits themselves. This could be achieved through GPS 
measurements or direct line of sight measurements between the various satel- 
lites. Feeding back mean orbit element errors has the benefit that any short 
period oscillations are ignored. 

Further, it is convenient to be able to adjust only certain orbit elements, 
leaving the remaining elements virtually untouched. For relative orbits designed 
using the Jz orbit element constraints, the resulting relative orbit will be J2 
invariant in an angular sense. This means that the neighboring orbits will have 
equal nodal and mean latitude drift rates. However, the argument of perigee and 
mean anomaly will still drift apart at equal and opposite rates. The consequence 
of this drift is that the relative orbit will go through cycles of symmetrically 
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growing and shrinking as the chief satellite completes one orbit. This effect is 
more noticeable for satellite clusters with larger eccentricities. For a cluster with 
nominally zero eccentricity, having the argument of perigee and mean anomaly 
grow apart at equal and opposite rates has no affect on the overall relative orbit 
geometry. Further, this impulsive firing scheme could also be used as the initial 
conditions for an optimizer solving for the true minimum fuel orbit correction. 
Often indirect optimizing methods are sensitive to initial conditions, and the 
presented impulsive feedback law could provide reasonable initial guess as to 
the structure of the optimal control solution. 


13.7.4 Hybrid Feedback Control Law 


The use of Eq. (13.40) is investigated here to create a hybrid continuous feedback 
control law in terms of Cartesian Hill frame coordinates, while describing the 
desired relative orbit geometry through a desired set of orbit element differences 
de*. Any desired states are denoted here with a superscript asterisk. The 
advantage of this type of hybrid control law is that the actual relative orbit 
is expressed in terms of coordinates in which it would actually be measured 
(i.e. the chief frame local Hill coordinates), while the desired relative orbit is 
conveniently expressed as a set of orbit element differences. 

Let 2 = (x,y,z)? be the deputy position vector and v = («,y,2)7 be 
the deputy velocity vector expressed in the chief Hill frame coordinates. The 
general linearized relative equations of motion for a Keplerian system, given in 


Eq. (13.18), are expressed here as? 
=v (13.254) 
Qfs + 6? 6 0 
o=| -6 @-H 0 |ea 
0 On See 
—_—_— 
A 
aa (13.255) 
0 26 0 Un 
+|-26 0 olv+ fu, 
0 0 0 Uz 
_—_—_—’ —— 
[Ag] o 


with @ being the true latitude. These relative equations of motion are valid for 
both circular and elliptic chief orbits. The true latitude acceleration is computed 
through 


§= 255 (a sin 0 — qp cos 8) (13.256) 


with q, and q2 being defined in Eqs. (13.42) and (13.43). 
Let us define the relative orbit tracking errors as 
Ag = 2-2" (13.257) 
Av =v—v* (13.258) 
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with the desired position and velocity vectors computed using 
eo 2 
X* = Ce = [A(e)]de (13.259) 


Note that if the desired orbit element differences call for a fixed mean anomaly 
difference, as is done in References 19, 20 and 21, then the vector de* is not 
constant, but rather 69 must be computed at each instant by solving Kepler’s 
equation. Further, note that Az = Av. 

Let us define the control law u as 


u=v* — Aya — Agu — |K]Aa — [P|Av (13.260) 


with [A] and [P] being positive definite matrices. To prove that u is asymptot- 
ically stabilizing, a positive definite Lyapunov function V is defined as 


V(Ax, Ay) = shet Ao + 5a" [K]Ae (13.261) 


Substituting Eqs. (13.255) and (13.258), the derivative of V along the state 
trajectory must be negative semi-negative 


V = Av? (Ab + [K]Ax) = —Av7 [P]Av (13.262) 


which guarantees that u is globally stabilizing. To prove that the control law 
is also asymptotically stabilizing, the higher order time derivatives of V are 
investigated. The second derivative of V is zero when evaluated on the set 
where V = 0. The third derivative 


V(Av = 0) = —2Aa@7[K][P][K] Ax (13.263) 


is negative definite in the state vector Aw. Since this first non-zero derivative 
is an odd derivative, the control u is asymptotically stabilizing.*° 

Note that &* — [A,]a* — [Ag]v* is zero if the desired relative motion is a 
natural solution to the linearized equations of motion shown in Eq. (13.255). 
Assuming that our chosen #* abides by 


* = [AJa* + [Ag]v* (13.264) 


the control law wu is written as 
u=—[Ai+K A.+P] (@ - [ACe)lse") (13.265) 


Note, however, that the desired relative motion may not necessarily be a natural 
solution. The control law in Eq. (13.260) is also valid for forced relative orbits. 
Studying this form of control law in Eq. (13.265), the hybrid nature of wu is 
evident in that the desired relative orbit is prescribed through a set of orbit 
element differences, while the actual motion is expressed in terms of the chief 
Hill frame Cartesian components. The advantage here is that we are able to 
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express the actual and desired relative motion in coordinates that best suit their 
task. The continuous feedback control law in Eq. (13.229), in contrast, feeds 
back tracking errors in terms of the inertial deputy position vector. The hybrid 
control law in Eq. (13.265) takes advantage of the fact that the deputy satellite 
position is controlled relative to the chief position by expressing the tracking 
errors in terms of the relative Hill frame coordinates. 

Since the [As] matrix is skew-symmetric, it could be dropped from the con- 
trol expression in Eq. (13.265). The Lyapunov-based stability proof remains 
the same and asymptotic stability is still guaranteed. However, computing V 
the term Av? [A|Av is dropped since it is always zero. The modified control 
expression is then 


u=-[Ai+K P| © e [A(e))se") (13.266) 


This control would no longer feedback-linearize the closed-loop dynamics, but 
it still guarantees asymptotic stability. 

Note that while the control expression in Eq. (13.265) takes advantage of the 
linear mapping [A(e)] between orbit element differences and their corresponding 
Hill Cartesian coordinates, the control expression in Eq. (13.260) does not rely 
on this mapping. In fact, the relative orbit tracking errors Av and Av could 
be computed using the complete nonlinear mapping between orbit elements 
and local Cartesian coordinates. Further, it is possible to incorporate the J2 
effect here by using Brouwer’s theory to compute the relative orbit errors in 
mean element space and then map the error vector back to osculating space for 
control purposes. 


Problems 


13.1. = Write a program that will display the orbit of satellite as seen by the rotating Hill 
reference frame of another satellite. 

13.2 ; : ; 
Let the chief orbit be determined through the orbit elements a = 7500km, e = 
0.01, 2 = 45 degrees, (2 = 0.0 degrees, w = 30 degrees and Mo = O degrees. 
The deputy orbit has the same orbit elements except for the 1 = 45.1 degrees 
and w = 29 degrees. 


a) Use the nonlinear relative equations of motion in Eq. (13.12) and plot the 
relative orbit in the Hill frame. 


b) Compute the relative orbit by using the inertial equations of motion in 
Eq. (13.11) and computing first the inertial deputy and chief orbits and 
then differencing them. Plot the result in the rotating Hill frame and 
compare to the previous answer. 


13.3. Using the chief and deputy orbit elements in Problem 13.2, compute the relative 
orbit using both the nonlinear relative equations of motion in Eq. (13.18) and the 
linear CW equations in Eq. (13.19) for different chief orbit eccentricities. Start 
with a zero eccentricity and increase it until a critical value is found where the 
CW relative orbit calculation is off by 1 km. 
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13.4 d& Starting with the nonlinear relative equations of motion in Eq. (13.17), derive 


13.5 


the non-dimensional relative equations of motion shown in Eq. (13.23). Include 
the derivation of the intermediate results shown in Eq. (13.22). 


Create a program that will perform both the forward and inverse mapping between 
the a relative orbit Cartesian position vector X and corresponding orbit element 
difference vector de shown in Eq. (13.40). Verify that the [A(e.)][A(ec)]~* does 
yield the identity matrix. 


13.6 d& Derive the non-dimensional Cartesian rate computation in Eq. (13.75). Show all 


13.7 


13.8 


intermediate steps. 


Use the orbit constraint condition in Eq. (13.85) to generate initial conditions 
that will yield a bounded relative orbit. Assume that the chief orbit is given by 
the orbit elements shown in Problem 13.2. Plot the resulting relative orbit in the 
rotating chief Hill frame. 


Verify the two J2-invariant orbit element constraints in Eqs. (13.155) and 
(13.156). Start with the J2-invariant relative orbit definition in Eqs. (13.146) 
and (13.147) and show all intermediate steps. 


13.9 d& Create a numerical simulation to compute the relative orbit shown in Exam- 


ple 13.4 by including the Jz through Js perturbations. This program should 
compute the inertial orbit of both the deputy and chief satellite and then map 
the relative orbit into the rotating chief Hill reference frame. Use the mapping 
shown in Appendix G to map between the mean and osculating orbit elements. 


a) Show how much the relative orbit still drifts despite the J2-invariant con- 
ditions. 


b) Of the Jo-Js gravitational perturbations, which one is the main cause for 
this drift. 


c) Show how fast the argument of perigee and mean anomaly are drifting 
away from their initial values. 
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APPENDIX A 


Transport Theorem Derivation 
Using Linear Algebra 





Previously the kinematic differential equation of the direction cosine matrix [C] 

and the Transport Theorem were derived using vector algebra results. This 

appendix will derive the same results using linear algebra arguments. While 

not as easy to visualize as the vector algebra results, the advantage here is that 

the derivation illustrates that these results hold for any N-dimensional space. 
Any NxN orthogonal matrix [C] must satisfy the constraints 


[C]?[C] = Inxw (A.267) 
[CIC]? = Inxw (A.268) 


where Ivy is an NxN identity matrix. Taking the derivative of Eq. (A.268) 
we find that 


[C][C\" + [CI[C]” = Onxv (A.269) 


Note that taking the derivative of a matrix here only involves a series of scalar 
derivatives when taking the time derivatives of the various matrix elements. 
Contrary to the vector algebra developments, we are not concerned with different 
reference frames here. Eq. (A.269) can be rearranged to the form 


(Cller” = -10eI" = - ([eer")* = 1 (A.270) 


where, by definition, the “angular-velocity-like” matrix [Q] must be skew-sym- 
metric. Therefore the derivative of aNxN orthogonal matrix can be written in 
the general form 


[C] = [@ Ic] (A.271) 


To illustrate that for the rigid body dynamics case [Q] = —[@], we write the 
direction cosine matrix in terms of the 6 frame unit vector components. Let b; 
be the 1x3 matrices whose elements are the NV frame components of the unit 
vectors b;. The 3x3 matrix [C] is then written as 


by 
[C] = | be (A.272) 
b3 
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The time derivative of [C] is then expressed as 
[C] = | be (A.273) 


Since the 6 frame unit vectors are fixed within the 6 frame, their differential 
equation is of the form given in Eq. (1.14). 


b; = w x 6; (A.274) 
Substituting Eq. (A.274) into Eq. (A.273) and making use of w = wb, +w2b2+ 
w3b3, the direction cosine matrix derivative is written as 


b —w9b3 = w3b9 
[C] = | wibs — w3b1 (A.275) 
Wy by Tr wb; 





Using the definition of the 3x3 tilde matrix in Eq. (3.23), this is written in the 
desired form. 


; 0 —W3 W2 by 
[C] =— |] w3 0 Wy ba} = —[@][C] (A.276) 
—W2 Wy 0 b3 


Therefore, for the case where [C] represents a rigid body attitude, the skew- 
symmetric matrix [Q] is equal to 


[(Q] = —[o] (A.277) 


Let a N-dimensional vector v have components taken in the VV and B frame. 
The Nx1 matrix v, contains the NV frame components of v, and vp contains the 
B frame components. These components are mapped from one reference frame 
to another through the corresponding direction cosine matrix [C]. 


up = [C]vn (A.278) 


Note that both vp and vu, in Eq. (A.278) are not treated as vectors, but as a list 
of scalars (i.e. a matrix). Therefore, taking the derivative of vp is equivalent to 
taking the derivative of the vector v as seen by the B frame. 


| 

Uy & ae (A.279) 
NG 

mn &— A.2 

On = a (v) (A.280) 


Taking the derivative of Eq. (A.278), we find 


iy = [Clin + [Clun (A.281) 
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Substituting Eqs. (A.271) and (A.278), this is rewritten as 
%» = [Clin + [Q][Clon = [Clin + [Q]ue (A.282) 


Solving for 0, we find a generalization of the transport theorem developed earlier 
using matrix notation. 


in = [C]” (dy — [Q]ve) (A.283) 
To show that Eq. (A.283) is equivalent to the transport theorem for the rigid 
body case presented in Chapter 1, we first use the identity [Q] = —[] 

in = [C]” (iy + [&]vs) (A.284) 


Using the relationships in Eqs. (A.279) and (A.280) and the equivalent vector 
operator to the tilde matrix operator, the transport theorem is written as a 
vector algebra expression as 


Nd Bq 


oe v) = ap +wXxv (A.285) 


where w = wy. Strictly speaking, Eqs. (A.284) and (A.285) are only equiva- 
lent if all the vector quantities in Eq. (A.285) have components taken in the NV 
frame. 
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APPENDIX B 


State Space Analysis 


text here 
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APPENDIX C 


Various Euler Angle 
Transformations 





This appendix contains mappings between the 12 sets of Euler angles 0 = 
(0;,02,03)7 and either the direction cosine matrix [C] or the body angular 
velocity vector w. 

The direction cosine matrix is defined as 


{b} = [C(O1, 02, 03) {A} 
Thus, it maps vectors with components in the inertial frame into vector with 


components taken in the body frame. The short hand notation cO; = cos 6; and 
s0; = sin 6; is used here. 


Direction Cosine Matrix in Terms of the 12 Euler Angle Sets 


802804 —sO2c01 
—s030c0280, + cO3c0,  s03Cc02c01 + cO3801 
—cO3c09801 a s03c01 €O3CO02cO01 —= 803804 


c03CO2 003802801 + 803cO1 €03802C01 + 803501 
—s03002 —s03802801 + cO3cO, 803802c0, + cO3801 
S02 —cO2s01 CO2c01 





802C01 802801 
c03Cc02c0, — 803801 00302801 + s03cO1 
—s63c02c01 — cO3801 —s03c02801 + cO3cO1 


003802C01 + 803801 003802801 — 803cO1 
COCO c02801 
+803802c0, — c0380, 803802801 + cO3cO1 
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—s03c02801 + cO3cO1 
802801 
€03C02801 + 803cO1 


803802801 + cO3cO1 
003802801 — s03c01 
0028041 


06201 
—c03802Cc01 + 8035801 
8035802C01 + cO3804 


003C02cO1 = 803801 
—s02c01 
803C02C01 + cO3801 


—s03802801 + cO3c01 
—cO2801 
003802801 + 803cO1 


cO3c01 — 803CO2804 
—s03c01 = c03c02804 
802861 


CO2 cOy 
803802C01 = 003501 
€03809C01 + 803801 


c03Cc02c01 — 803801 
—sO3cO2c01 = 003801 
s02c01 
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—sO3c02c01 — C0380, 
s802c01 
003C02c0, = 803801 


sO3 s02 
cO2 
—c3 sO2 


803802C01 = 003501 
003802C01 + 8035801 
002CO1 


—cO2801 
003802801 + 803cO1 
—s03802801 + cO3cO1 


—cO3C02801 = s803c01 
80280, 
—s03c0280, + cO3c01 


cO3 sO2 
cO2 
803802 


80380cO01 + cO3801 
00201 
—cO3802Cc01 + 803501 


c03801 + 803cO2c01 
—s0380, + cO3cO02c01 
—s02c01 


002804 
803802801 + cO3CcO1 
€O3802801 = 803c0, 


003c02801 + s03cO1 
—s030c02801 + cO3cO1 
802801 





Fees! 803cO2 
S02 
cO3 cO2 


803805 
003802 
cO2 


—sbo 
80302 
cO3CO2 
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The following list provides the various forward and inverse mappings between 
the body angular velocity vector w and the Euler angle rates 0 = (61, 62,03)". 
The matrix [B] is defined as 


6 = [B(0)|w 


The short hand notation cO; = cos 6; and s0; = sin 6; is used again here. 


Mapping Between Body Angular Velocity Vector and the Euler Angle Rates 


803 cO3 0 
802c03 —s02803 802803 cO3 
—c2803 —cO2c03 s802c03 —s03 


cO3 —sO3 0 
cO2 s03 cO2c63 0 
—s02c03 802803 cO2 


0 —cO3 s03 cO2 
0 802803 802c03 —s02c03 
802 CO2c03 —cO2803 802803 


803 cO3 0 €O2803 cO3 
cO2c03 —cO2s803 0 cO2C03 —s63 
802803 s02c03  cO2 —s02 0 


cO3 —sO3 802 0 
cO2 803 cO2 cO3 cO2 cO3 803 
—s02c03 802803 —cO2803  cO3 
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s02 cO3 —s3 
cO2 0 
802803 cO3 


—cO2 s03 cO3 
s02 0 
cO2c03 803 


cO2 cO3 —cO2 803 
cO2 sOo s03 802c03 


—cO3 803 —s02c03 s03 
802803 s02c03 802803 cO3 
c62c03. ~—cO2803 cO2 0 
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APPENDIX D 


Various Proofs 





This appendix contains various proofs and developments of identities used within 
the text. Typically proving these identities where they were used would have 
been distracting, so these proofs were added to this appendix. 

In developing the MRP rates relative to a rotating orbit frame O, the identity 


[B(o)|[BO(a)] = [B(o)]* (D.286) 


was used. This identity can be developed from the basic MRP definitions of the 
[B] and [BO] matrices. Using Eqs. (3.144) and (3.150) we find 


gle]? — 4(1 — 0?) [6] 


= (1-0?) ng +218) +2007)( Ina + SEA 


) (D.287) 
Substituting the identity 
[a]? = aa? — 07 I3y3 (D.288) 


and expanding the matrix product, [B(o)|[BO(o)] is rewritten as 


[B(o)][BO(o)] = (1 — 0?) Iaxg + 2[6] +2007 + (2007(1 9") 


4 
— 207(1 — o”)Isx3 — (1 — 0?)?[6] — 407 [6] — 2(1 — o°)[6)*) (D.289) 


Using Eq. (D.288) again, this is then reduced to 





[B(o)|[BO(o)] = (1 — 07) I3x3 + 2[6] + 2007 — ae (D.290) 
= (1-07) Isx3 —2[6] + 2007 (D.291) 
= [B(o)|* (D.292) 
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APPENDIX E 


Conic Section Transformations 





Various transformations exist between the conic section elements. The com- 
monly used mappings were developed in the previous celestial mechanics chap- 
ters. This appendix provides a complete list of all possible transformations 
between the orbit elements a, b, p, Ta, Tp and e for both the elliptical and 
hyperbolic case, as well as various anomaly mappings and sensitivities. 


Elliptic Orbit Elements 
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Elliptic Anomaly Mapping and Sensitivities: 


Vl—e*sinE snp ae Vice’ sinf 








a Aa 1—ecosE 1+ ecos f 
cos FE —e e+ cos f 
ge Pisce Rigen ae Spi Se ee 
Coe: 1—ecosE ae 1+ecosf 
f 1l+e E l-—e f 
tani = tan — tan — = tan 4 
eT ise oy Neaeaee 9 


df vl -—e? 1+ecosf _ 


b 

dE 1—ecosE V1 — e2 r 
if 

a 


69 
Seen 
dE 1+ecosf 


dM  (1-—ecosE)? (ise7e2 r 


“df V1 — e2 ~ (+ecos fy? ab 
Hyperbolic Orbit Parameter Transformations 


Note that by convention the semi-axis a and b are chosen to be negative quanti- 
ties for the hyperbolic case. Since rg — oo for a hyperbola, the transformations 
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using rq are omitted from the following list. 





Hyperbolic Anomaly Mapping and Sensitivities: 


. Ve? — 1sinh H , ve? —l1sinf 
sin f = —————£!,_ sinh H = ——————— 
ecosh H — 1 ecos f+1 
— cosh H 3 
Ka ae eT 
, ecosh H — 1 ecos f +1 


568 


f e+1 A 
See pe 
2 ea 


af »_- e?—1 
dH  ecoshH—1 
dN 


a ne 


dN _ (ecoshH —1)? 


a 


e2 —1 
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_ecosf+1 bd 


e2—1 TE. 


e? —1 Tr 


ecos f +1 ~ | 


(e? if 1)8/? r2 
~ (ecosf+1)2 ab 


APPENDIX F 
MATLAB M-Files 





A rigid body kinematics MATLAB toolbox is included with this textbook in 
the form of a series of M-Files. The operators perform transformations between 
various sets of attitude coordinates, form the composition of two successive 
rotations, compute the relative attitude vector between two orientations and 
computes the time derivative of the attitude parameter vector. The attitude 
coordinates covered in this toolbox include the direction cosine matrix [C], the 
Gibbs or classical Rodrigues parameter vector q, the modified Rodrigues pa- 
rameter vector o, the principal rotation vector -y and the 12 sets of Euler angle 
vectors 6;;,. The scalar indices i, 7 and k are either 1, 2 or 3. All transforma- 
tions used in this toolbox are introduced in Chapter 3. 

The function DirCos...(q) returns the 3 x 3 direction cosine matrix [C] 
corresponding to the particular choice in attitude coordinates. Instead of ..., 
the user adds what type of attitude vector q is. For Euler parameters, an EP is 
added. If q is a Gibbs vector, then Gibbs is added. The MRP vector simply has 
MRP added, while the principal rotation vector has PRV added. If q is an Euler 
angle vector, then Eulerijk is added where 7, 7 and k are replaced with the 
appropriate rotation sequence. Therefore, if q is a (3-2-1) Euler angle vector, 
then the corresponding direction cosine matrix is found through the command 
DirCosEuler321(q). The attitude coordinate abbreviations introduced here 
are used throughout the MATLAB subroutines. A direction cosine matrix [C] is 
translated back to the various attitude parameters using the command C2... (C). 

To translate between various 3 or 4 parameter attitude coordinate sets, the 
command ...2...(q) is used, where the ... are replaced with the previously 
discussed attitude coordinate choice abbreviations. Whenever possible, direct 
transformations between the various sets are used to provide numerically effi- 
cient code. 

The command q = add... (qi,q2) computes the composition of the two 
successive rotations qi and q2. Note that both qi and q2 must be the type 
of attitude parameters. Let A’, B and F be three reference frames, then q is 
defined through the relationship 


[FN(q)] = [FB(q2)I[BN(a1)] (F.293) 


To compute the relative orientation vector q2, the attitude vector qi is “rota- 
tionally” subtracted from q. Using the direction cosine matrix notation, this 
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corresponds to 


[F B(q2)] = [FN(q@)I[BN(a1)I* (F.294) 


The command to find the relative orientation vector q2 is sub... (q,q1). 
The attitude coordinate rate vector gq is related to w through a matrix [B(q)]. 


q = [B(q)|w 


The MATLAB command d...(q,w) computes the time derivative of the atti- 
tude vector q for a given body angular velocity vector w. For example, if q is 
a (1-2-3) Euler angle vector, then the command dEuler123(q) would be in- 
voked. Subroutines are also provided that compute just the [B(q)] matrix and 
it’s inverse. All attitude coordinates discussed have compact analytical inverse 
formulas for [B(q)] as shown in Chapter 3. The [B(q)] matrix is computed with 
the command Bmat...(q) and its inverse with Binv... (q). 

The following alphabetical list details the purpose of each MATLAB function 
provided in the rigid body kinematics toolbox. 


(F.295) 


addEP (q1,q2) 
addEulerijk(q1,q2) 
addGibbs (q1,q2) 


Sum the two Euler parameter vectors. 
Sum the two (i-j-k) Euler angle vectors. 
Sum the two Gibbs vectors. 


addMRP (q1 ,q2) Sum the two MRP vectors. 

addPRV (q1,q2) Sum the two principal rotation vectors. 
BinvEP (q) Compute the inverse of [B()]. 
BinvEulerijk(q) Compute the inverse of [B(0;;x)]. 

BinvGibbs (q) Compute the inverse of [B(q)]. 

BinvMRP (q) Compute the inverse of [B(o)]. 

BinvPRV(q) Compute the inverse of [B(-+)]. 

BmatEP (q) Compute the matrix [B()| 

BmatEulerijk(q) Compute the matrix [B(0;;x)] 

BmatGibbs (q) Compute the matrix [B(q)] 

BmatMRP (q) Compute the matrix [B(o)| 

BmatPRV(q) Compute the matrix [B(-)] 

C2EP (C) Extract the Euler parameters from [C]. 
C2Eulerijk(C) Extract the (i-j-k) Euler angles from [C]. 
C2Gibbs(C) Extract the Gibbs vector from [C]. 

C2MRP (C) Extract the MRP vector from [C]. 

C2PRV(C) Extract the principal rotation vector from [C]. 
dEP (q,w) Compute the Euler parameter time derivative. 


dEulerijk(q,w) 
dGibbs (q,w) 


Compute the (i-j-k) Euler angles time derivative. 
Compute the Gibbs vector time derivative. 


DirCosEP(q) Translate the Euler parameters into [C]. 
DirCosEulerijk(q) Translate the (i-j-k) Euler angles into [C]. 
DirCosGibbs(q) Translate the Gibbs vector into [C]. 
DirCosMRP (q) Translate the MRP vector into [C]. 


DirCosPRV(q) 


Translate the principal rotation vector into [C]. 


APPENDIX F 


dMRP (q,w) 
aPRV(q,w) 


elem2PRV(q) 
EP2Eulerijk 
EP2Gibbs 
EP2MRP 

EP2PRV 

Euleri (theta) 
Euler2 (theta) 
Euler3 (theta) 
Eulerijk2EP (q) 


Eulerijk2Gibbs (q) 


Eulerijk2MRP (q) 
Eulerijk2PRV(q) 


Gibbs2EP (q) 
Gibbs2Eulerijk(q) 
Gibbs2MRP (q) 
Gibbs2PRV(q) 
MRP2EP (q) 
MRP2Eulerijk(q) 
MRP2Gibbs (q) 
MRP2PRV (q) 


MRPswitch(q,S) 
PRV2elem(q) 


PRV2EP (q) 
PRV2Eulerijk(q) 
PRV2Gibbs (q) 


PRV2MRP (q) 
subEP (q,q1) 


subEulerijk(q,q1) 
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Compute the MRP vector time derivative. 
Compute the principal rotation vector time 
derivative. 

Translates the (®, €1, €2, €3) into the 

principal rotation vector. 

Translate Euler parameters into (i-j-k) Euler angles. 
Translate Euler parameters into a Gibbs vector. 
Translate Euler parameters into a MRP vector. 
Translate Euler parameters into a PRV vector. 
Returns the elementary rotation matrix 

about the first body axis. 

Returns the elementary rotation matrix 

about the second body axis. 

Returns the elementary rotation matrix 

about the third body axis. 

Translate the (i-j-k) Euler angles into Euler 
parameters. 

Translate the (i-j-k) Euler angles into the 

Gibbs vector. 

Translate the (i-j-k) Euler angles into MRPs. 
Translate the (i-j-k) Euler angles into the 
principal rotation vector. 

Translate the Gibbs vector into Euler parameters. 
Translate the Gibbs vector into (i-j-k) Euler angles. 
Translate the Gibbs vector into MRPs. 

Translate the Gibbs vector into the principal 
rotation vector. 

Translate the MRPs into Euler parameters. 
Translate the MRPs into (i-j-k) Euler angles. 
Translate the MRPs into the Gibbs vector. 
Translate the MRPs into the principal rotation 
vector. 

Switch the MRP vector such that |o|? < S. 
Translates the principal rotation vector 

to (®, é1, é2, é3). 

Translates the principal rotation vector to 

Euler parameters. 

Translates the principal rotation vector to 

(i-j-k) Euler angles. 

Translates the principal rotation vector to the 
Gibbs vector. 

Translates the principal rotation vector to MRPs. 
Compute the relative Euler parameter vector from 
qi to q. 

Compute the relative (i-j-k) Euler angles vector 
from q1 to q. 
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subGibbs(q,q1) Compute the relative Gibbs vector from q1 to q. 
subMRP (q,q1) Compute the relative MRP vector from qi to q. 
subPRV(q,q1) Compute the relative PRV vector from qi to q. 
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First-Order Mapping Between 
Mean and Osculating Orbit 
Elements 





A first-order mapping algorithm is outlined in this Appendix based on the the- 
ory developed by Brouwer in Reference 1 and Lyddane in Reference 2. The 
modifications suggested by Lyddane allow for a more robust mapping near zero 
eccentricities and inclination angles. 

This mapping directly translates any osculating (instantaneous) orbit ele- 
ments into mean (orbit averaged, with short and long period motion removed) 
orbit element equivalent values. Only first order Jz terms are retained in this 
algorithm. Note that the forward and inverse transformation here is not perfect 
due to the first-order truncation of the infinite series. Small errors of order J 
are to be expected. 

Note that since a first-order truncation is performed of the infinite power 
series solution, the forward and inverse mapping function between the mean 
and osculating orbit elements only differs by a sign. Let the original orbit 
elements be given by e = (a,e,i,Q,w,M). Note that these elements could 
be either mean or osculating orbit elements. The transformed elements will 
be given through e’ = (a’,e’,7’,Q’,w’, M’). With r. being Earth’s equatorial 
radius, the parameter ‘2 is either defined as 

2 = 2 (“) (G.296) 
2 NG 
if the algorithm maps mean orbit elements to osculating orbit elements, or as 
Jo 
2 
if the algorithm maps osculating orbit elements to mean orbit elements. 
Defining 7 = V1 — e?, the parameter 74, is then defined as 
eo (G.298) 
1) 
The mean anomaly M is translated into the corresponding eccentric anomaly 
F using Kepler’s equation. 


ie (=) (G.297) 


a 


M=E-esinE (G.299) 
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The true anomaly f is computed using 


fS2tan* ( © tan @) (G.300) 


The ratio a/r is computed using 





a __ 1+ecosf 


2 (G.301) 


with r being the current orbit radius. 


The transformed semi-major axis a’ (which could be either the mean or 
osculating state, depending on whether a is an osculating or mean element) is 
computed through 


ad = a+ ay2((3.c0s?é — 1) ((2): . =) 


+ 3(1 — cos? #) G) cos(2w + 21)) (G.302) 


To following parameters are intermediate results used to transform the re- 
maining orbit elements. 


/ 4- 
de, = er? (1- 11 cos? i — 49 ~~ 


3 ) cos(2w) (G.303) 


1 — 5cos?i 

+ : +3cos f 
f ee : 
” 1+ 


1 — cos? i 
+ 3e cos? f + e? cos? f) +3——~*( 
1) 


+ 3cos f + 3ecos” f + e? cos® f) cos(2w + 2f)] 


2 3 24-1 
be = de, + 4 {y)[-— — ( 
2 n 


(G.304) 





— ¥5(1 — cos? i) (3 cos(2w + f) + cos(2w + 3f)) \ 


/ 
i= ene) + 2 cosiv/1 - cos? i(3 cos(2w +2f) 


n?tani 2 
+ 3ecos(2w + f) + ecos(2w + 3f)) 





(G.305) 


APPENDIX G 975 


4 





/ 47 
M'+u'+0'=M 04 Bn (1 — Leos? i - 40) 
+w + +w+ tg cos” 2 0c 
/ 
— 12 (246? — 11(2 + 8¢?) cos? 
cos* i cos® 4 
— 40(2 + 5e2) =“ — 4002 _—*___ ) 
oe Theos : (1 — 5 cos? 7)? 
if 
+ 2 (6 «(1 —5cos*i)(f — M+ esin f) 
+ (3 — 5cos? 4)(3 sin(Qw + 2f) + 3esin(2w + f) 
+ esin(2w +3/))) 
Woo Gik. 2s ( cos? i cos* i ) 
— 72.2 cog i(11 + 80S 4. 29009 _S * _ 
Be ee eae coata )  eceee 


/ 
- 72 cos i(6(f — M+ esin f) 


— 3sin(Qw + 2f) — 3esin(Qw + f) — esin(Qu + 3f)) 


(G.306) 
= ele. 2. cos* 4 
(eM) = Zen (1 11 cos? i 10.) 
_ ay ap ay (EY eae 
47 {2(3cos i 1 (( =) +241) sing 
oe (G.307) 
+ 3(1 — cos? i) (- (=) =a, 1) sin(2w + f) 





+ (+844) me-tan}} 


25 4; 
Yo. cos? i cos* i 
6Q = -—= 3 (11+ 80 -————_— 200, ) 
cis Tayo (1 — 5 cos? i)? 





- 2 cosi(6(f — M+ esin f) — 3sin(2w + 2f) 
— 8e sin(2w + f) = esin(2w + 3f)) 
(G.308) 


Now we are ready to compute the remaining transformed orbit elements. By 
defining 
d, = (e+ de) sin M + (e6M) cos M (G.309) 
dy = (e + de) cos M — (ed M) sin M (G.310) 





the mean anomaly M’ is computed using 


M' = tan! (2) (G.311) 
dy 
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while the eccentricity e’ is computed using 


e = 4/d}+d3 


Similarly, we define 


d3 = (sin (5) + cos (5) =) sin + sin ( ) 62 cosQ 
. [i i\ bt 2 : 
d4 = (sin (5) + cos (5) =) cos 9) — sin ( ) 6ONsinQ 


to compute the ascending node 1’ through 


Q! = tan71 (2) 


and the inclination angle 7’ through 


}—23n- (Ve +é) 


Finally, the argument of perigee w’ is computed through 


Nl s 





N| °. 


w! = (M’ +0’ +0')- M’-' 


APPENDIX G 


(G.312) 


(G.313) 


(G.314) 


(G.315) 


(G.316) 


(G.317) 


Note that when computing the inverse tangent functions in the algorithm above, 
care must be taken such that the resulting angle lies in the proper quadrant. 
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